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Abstract 

A  systematic  procedure  Is  used  to  design  Kalman  Filters  for  a 
hypervelocity  missile  system.  The  procedure  includes  truth  model 
development,  state  space  model  formulation,  filter  tuning,  and  Monte 
Carlo  analysis.  The  study  Is  based  upon  a  planar  engagement  of  highly 
dynamic  missile,  a  constant-velocity  aircraft,  and  a  stationary  target 
Two  line-of-slght  filters  are  developed  using  the  rotating  alrcraft-to- 
target  llne-of-slght  frame  as  a  reference  and  two  inertial  filters  are 
developed  using  an  inertial  frame  reference.  The  angle  between  the 
alrcraf t-to-target  llne-of-slght  and  the  aircraf t-to-nissile  llne-of- 
slght  is  the  only  physical  measurement  processed  by  the  filters.  Due 
to  ohservablllty  considerations,  the  inertial  filters  also  process 
additional  pseudo-measurements  of  range.  The  filters  are  compared  by 
calculation  of  miss  distance  statistics,  probability  of  kill,  and 
computational  loading. 
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A  CnriPARATLVt:  ATIALYSIS  of  KALMAN  FtLTKRS 
ilSCNf:  A  KYFLRVKLOCITV  MI.SSILK  SIMULATION 


1.  iriTROOUCTION 


l.l  Tl;ick;’rounH 

The  United  States  T)i> jiart.nent  af  l)<;fense  has  stressed,  especially 
diirln®  the  last  decade,  alr-to-surface  weapon  research  and  development. 
The  motivation  for  tliis  empiiasls  com-js  from  a  large  escalation  in  the 
nunhers  .and  qualities  of  tank.s  deployed  by  the  Warsaw  Pact  countries. 

The  Soviet  Union,  in  particul.ar,  is  .adding  5000  ground  combat  vehicles 
to  its  Inventory  each  year  (Ref.  4).  Among  these  vehicles  is  the 
T-64/T-72  series  of  battle  tanks  whicli  are  superior  in  quality  to  any 
comparable  system  cieploycd  by  !l\TO  (Ref.  4).  The  buildup  in  Soviet 
forces  has  generatod  a  significant  tnunerical  advantage  in  tanks  over  tlio 
combined  NATO  forces.  The  United  .St.ates  .and  other  NATO  countries  are 
preparing  to  meet  tills  threat  by  relying  on  anti-tank  guided  weapons 
(.ATGWs).  There  are  two  major  development  objectives  of  ttie  type.s  of 
weapons  under  consideration.  Tbe  first  is  to  design  wet\pon  systems  that 
can  penetrate  the  conpar.atlvely  tliin  upper  surfaces  of  a  tank.  The 
other  is  to  use  tlie  U.S.  advantage  in  micro-electronics  to  develop 
precision-guided  munitions  (PGMs)  with  Iiigh  probabilities  of  kill.  A 
weapon  which  ha;;  tlio  pottuitial  to  meet  tliese  criteria  is  the 
hypervelocity  missile  (llV'i). 

The  IP/M  concept  Incorporates  av’all.able  technologies  In  the 
development  of  a  complete  weapon  system.  T!ie  objective  of  the  ilVM  is 
to  defeat  advanced  armored  ground  vefiicles  witti  small,  low  cost 
missiles.  The  missiles  are  launched  from  an  advanced  fighter  aircraft 
such  as  an  F-16  or  A-10.  The  velocity  of  the  missile  Is  approximately 
5000  feet  per  second  and  its  maximum  liown-range  launch  distance  is 
15,000  feet.  The  lethal  mechanism  of  Llie  U\'tl  is  a  nonexplosive. 
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kinetic  energy  penetratoc.  The  speed  of  the  missile  and  its  mass 
results  in  the  kinetic  energy  necessary  to  disable  the  target.  A 
carbon-dioxide  laser  is  deployed  on  the  aircraft  to  provide 
s imnltaneous  guidance  information  to  multiple  (up  to  10)  independently- 
targeted  missiles. 

Though  the  primary  emphasis  of  tlie  IIVM  concept  involves  achieving 
n  target  kill,  cost  effectiveness  and  aircraft  survivability  are 
primary  concerns  to  the  Air  Force.  Analyses  conducted  in  the  Armament 
Otvlslon  at  F.gHn  Air  Force  Base  have  demonstrated  that  the  HVM  shows 
promise  as  a  future  Air  Force  weapon  system.  The  potential  for 
enhanced  aircraft  survivability  exists  since  one  pass  near  a  target  is 
normally  sufficient  to  disable  it.  The  analyses  also  demonstrate  that 
the  low  IIVM  cost  should  provide  a  more  cost-effective  system.  In 
arlclition,  the  increcise  in  kills  per  .-ilrcraft  pass  should  decrease  the 
cost  per  targol-  killed.  These  advantages  have  prompted  the  Air  Force 
to  proceed  with  feasibility  studies  and  tests  to  demonstrate  the 
capabilities  of  the  KVM. 

1.2  Statement  of  Problem  and  Objectives 


The  tactical  missile  Intercept  problem  deals  wltli  guiding  the 
missile  to  the  target,  with  imperfect  knowledge  of  target  and  missile 
positions.  The  missile  uses  information  provided  by  the  sensors  and 
the  launching  aircraft  to  estimate  the  necessary  information  For 
guidance.  The  objective  of  this  thesis  is  to  develop  this  estimation 
process  for  tlie  IIVM. 

The  assumption  of  perfect  knov/ledge  of  quantities  that  describe  a 
system  is  often  inadequate,  'uncertainties  are  inherent  in  any  system 
and  their  neglect  frequently  results  in  degraded  performance.  Examples 
of  uncertainties  that  exist  in  tactical  missile  engagement  are  inherent 
mathematical  modeling  errors,  external  disturbances,  and  measurement 
These  iincerta  Int  ies  are  mod<'led  as  randoi't 
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phenomena,  thus  leading  to  stochastic  equations  to  describe  the  system. 
Stochastic  estimation  Js  a  method  of  formulating  a  best  guess  of 
certain  state  variables  of  importance  based  upon  noisy  observations  of 
the  system.  The  Kalman  Filter  is  the  optimal  stochastic  estimation 
algorithm  for  linear  dynamical  systems  subjected  to  Gaussian  noise. 
Nonlinear  systems  can  often  bo  sucoesaPully  treated  by  straiglit-forward 
extensions  of  the  Kalman  Filter  (Ref.  2,  6,  8,  14). 

The  KVM  system  requires  an  extremely  higli  accuracy  in  order  to  be 
an  effective  weapon.  Uncertainties  in  tlie  system  have  tlie  potential  to 
degrade  performance  and  thereby  thv/art  the  achievement  of  the  desired 
accuracy.  The  objective  of  this  study  is  to  design  alternative  Kalman 
Filters,  which  account  for  the  sj'stem  uncertainties,  and  to  compare 
their  perfornance  in  terms  of  state  estimation  accuracy,  statistics  of 
terminal  miss  distance,  probability  of  kill,  and  computational 
requirements.  Due  to  the  use  of  a  kinetic  energy  penetrator,  the 
probability  of  kill  is  also  a  function  of  the  angle  of  Incidence  of  the 
missile  with  the  target.  Th.is  factor,  however,  is  not  modeled  in  this 
study  since  its  inclusion  has  no  effect  on  Kalman  Filter  design.  The 
angle  of  incidence  would  be  accounted  for  in  the  guidance  law 
formulation,  however;  this  is  beyond  the  scope  of  this  study. 

A  Kalman  Filter  is  designed  for  the  HVM  system  based  on  a 
systematic  approach.  The  procedure  is  as  follows  (Ref.  9:341): 

1.  Develop  and  validate  a  truth  model  (^  complete,  complex 
mathematical  model  tliat  portrays  system  beliavior^ very  accurately). 

2.  Generate  a  Kalman  Filter  based  upon  the  total  truth  model. 

This  filter  is  used  as  a  henchmarV  of  performance  in  judging  other 
f i Iters . 


3.  Propose'  simplified,  reduced  order  system  models  by  removing  or 
combining  states  associated  v/lth  nondominant  effects,  deleting  weak 
c ross-coupl inn  terms,  and  employing  approximations.  Develop  simplified 
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filters  based  on  each  model. 

4.  Conduct  a  covariance  performance  analysis  of  each  proposed 
Kalman  Filter  being  driven  by  measurements  from  the  truth  model  of  the 
real  system.  Then  tune  each  filter  to  provide  the  best  possible 
performance  from  each. 

5.  Perform  a  Monte  Carlo  analysis  for  the  filters  that  show 
promise . 


6.  Conduct  a  performance/compiiter  loading  trade-off  analysis  and 
select  a  design;  investigate  square  root  and  other  forms  of 
implementing  the  chosen  design. 

7.  Implement  the  chosen  design  on  the  online  computer  to  be  used 
in  the  final  system. 

8.  Perform  checkout,  final  tuning,  and  operational  test  of  the 
filter. 

The  first  six  steps  of  Che  procedure  are  pursued  in  this  study.  Though 
the  approach  is  difficult  and  time-consuming,  it  is  cost-effective  in 
that  It  solves  most  of  Che  design  problems  before  accual  hardware 
Implemen CaCion  takes  place. 

1.3  Organization 


The  six  chapters  of  this  thesis  closely  follow  this  design 
procedure.  Chapter  I  provides  background  information  and  states  the 
oblectives  of  this  study.  In  Chapter  II  the  system  truth  model  Is 
developed  with  primary  emphasis  on  the  dominant  dynamic  characteristics 
of  the  system.  Also  Included  in  this  chapter  are  coordinate  frame 
definitions  and  engagement  scenario  assumptions.  Chapter  III 
contains  the  development  of  the  four  Kalman  Filters  which  are  to  be 
investigated.  Chapter  IV  discusses  the  implementation  of  the  models 
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Into  a  computer  simulation.  In  addition,  truth  model  and  filter 
validation  are  discussed.  The  analysis  of  the  four  filters  is  the 
topic  of  Chapter  V.  Conclusions  and  recommendations  for  further 
study  are  provided  in  Chapter  VI. 


II.  SYSTIiM  TRUTH  MODEL 


2.1  Introduction 


Tite  sy,yl:<>»i  triiMi  m<idol  reprcsont-it  ion  Is  very  importiint  In  Kalman 
Filter  doslj’n  and  performance  analysis.  The  fidelity  of  the  truth  model 
'.rill  have  a  direct  effect  on  tVie  accuracy  of  the  performance  analysts 
results.  It  is  therefore  imperative  that  models  accurately  represent 
system  dynamics  anii  otlier  appropriate  characteristics. 

This  ch.apter  contains  a  truth  model  for  a  hypervelocity  missile 
system.  The  tnitli  model  contains  realistic  models  for  the  missile, 
tar;?,et,  aircraft,  and  their  engasement  profiles.  The  mathematical  model 
represents  the  dominant  dynamic  characteristics,  relationships  that 
describe  sampled-data  measured  outputs,  and  other  functions  of  interest. 

The  truth  model  is  developed  based  on  a  three-dimensional  profile. 
Since  tlie  filters  deslgneil  in  Chapter  Hi  are  limited  to  the  vertical 
plane  for  simplicity,  the  truth  model  lateral  motion  components  are  set 
to  rero. 


These  system  models  are  used  in  a  digital  computer  simulation  to 
obtain  trvie  missile  tra  jectories  and  miss  distances,  tlius  motivating  the 
name  "system  truth  mndel".  Kalman  Filters  are  developed  in  Chapter  III 
and  Monte  Carlo  analyses  on  the  nonlinear  models  are  performed  to 
compare  outputs  from  the  trut!)  model  anil  the  filters  (Figure  2-1).  The 
Monte  Carlo  analysis  ,is  usc^d  to  estimate  the  statistics  of  filter  state 
estimates  versus  the  truth  model  stales.  Iterations  of  this  analysis 
allows  filter  narameters  to  he  tuned  for  best  filter  performance.  The 
Kalman  Filter  is  based  on  tbc  truth  model  but  is  of  lower  order.  Thus, 
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Figure  ?-l.  Truth  Motlel  and  Filter 

Tlelationship  in  Performance 
Analys  Is 

=  true  states 

=  inensurGinent 

Xf  =  estimated  states 

r^t  ~  noise  added  t<^  trutli  model 

C  =  conversion  of  truth  model  states  to  form  and  dimension  of 
filter  states 

^  =  truth  mode]  states  in  the  form  and  dimension  of  the  filter 
s  tates 

e  =  errors  in  estimated  states 
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to  I'.omporo  t’no  trutli  model  end  filter  states  It  Is  necessary  to 
transform  tlic  true  state.s  to  the  form  of  the  filter  states.  This 
transformation  is  Indicated  by  “C"  in  Figure  2-1. 

The  system  block  diagram  shown  In  Figure  2-2  depicts  the  major 
functional  components  and  their  input  and  output  relationships.  The 
truth  model  includes  all  blocks  except  the  filter. 

2.2  Coordinate  Frames 


The  reference  frames  used  in  this  study  are  Che  Inertial,  missile, 
target,  aircraft,  ai rcraf t-to-target  line-of-slght  (ATLOS),  and 
m  1  sslle-to-target  1  Ine-of-sight  (ilTl.OS).  Each  frame  is  right-handed 
and  ortliogonal.  Figure  2-3  depicts  a  planar  view  of  the  coordinate 
frames.  Each  is  showt\  witii  its  one  and  Cliree  axes  in  Che  plane  of  c)ie 
pag.c.  Tlie  miinluT  two  u>:is  of  each  fraiiH'  Is  not  shown,  but  points  out  of 
the  page.  The  inertial  frame  is  an  earth-fixed  frame  with  i| 
horizontal  down  range,  i2  cross  range,  and  ij  pointing  down.  It  is 
fixed  f'n  the  target  at  missile  launcli  and  remains  at  tliat  location  for 
the  duration  of  flight.  This  frame  is  assumed  Inertially  stationary  due 
to  the  very  siiort  missile-target  engagement  time.  The  missile  reference 
frame  Is  fixed  at  tlie  missile's  center  of  gravity  (M)  .  The  m]^  axis 
lies  along  the  missile  velocity  vector.  The  m2  and  m3  axes  are 
directed  along  tl)G  pitch  (positive  in  up  direction)  and  yaw  (positive  to 
the  right)  axes,  respectively.  Both  the  aircraft  (A)  and  the  target  (T) 
are  treated  as  point  masses  with  and  ti  pointing  in  the  direction 
of  the  aircraft  velocity  and  target  velocity,  respectively.  The  other 
two  axes  are  directed  to  tiie  right  of  the  velocity  vector  and  down  when 
the  aircraft  and  target  are  traveling,  in  a  straight  and  level  path 
parallel  to  tl'o  I],  12  plane.  The  AThOS  frame  is  denoted  by  £3, 

^2  j  and  £3  witli  tiie  origin  located  at  the  target.  This  frame 
rotates  with  the  llnc-of-sight  between  the  aircraft  and  target,  such 
tlint,  i\  is  always  directed  along  this  line.  The  £2  ^nd  £3 
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Lgure  2-2.  System  Block  Diagram 


axes  form  tlie  other  orthogonal  comp(>nonts ,  such  that,  ^2  Is  directed 
to  the  right  and  £3  is  directed  down  when  the  ATLOS  is  horizontal. 

The  same  type  of  orientation  applies  to  the  MTLOS  frame  with 
originating  from  the  missile  center  of  gravity  and  pointing  in  the 
line-of-sight  direction,  k2  pointing,  to  the  right,  and  k3  pointing 
down.  Appendix  A  contains  angular  relationships  and  coordinate 
transformations  iictween  -the  referenc.’  frames. 

1.1  Missile  Model 

This  section  describes  tiie.  missile  and  develops  its  three- 
degcee-of-f reedon  dynamics.  Included  in  the  development  is  a  simplified 
second-order  mode],  for  tiie  actuator/airframe  attitude  dynamics. 

"orraally,  the  attitude  dynamics  would  be  developed  in  detail  with 
consideration  of  a  six-degree-of-freedom  model.  However,  missile 
rotational  dynamics  are  tyoically  of  a  much  higher  frequency  than  tl»e 
translational  dynamics  which  tlie  K;ilman  Filter  estimates.  Therefore, 
approximating  tiie  rotational  dynanic.s  has  very  little  effect  on  the 
performance  of  tiie  Kalm;in  Filter  and  vice-versa.  In  addition, 
aerodynamic  data  describing  a  hypervelocity  missile  is  proprietary  and 
tiius  unavailable  for  general  use.  These  data  include  vital  information, 
such  as  moments  of  inertia  and  other  aerodynamic  data,  which  are  needed 
for  a  six-dogreo-of-freedom  simulation. 

2.3.1  .As sump t  i ons .  The  type  of  missile  used  in  this  analysis  is 
a  highly  manenve  rable ,  .sliort-rang,e,  tail  fin  controlled,  alr-to-sur  face 
missile.  It  is  3.5  in.  in  diameter  and  72  in.  long.  The  maximum 
lateral  acceleration  tiiat  tlte  missile  can  commaml  is  assumed  to  be 
100  g's  (3,2.00  ft/seC')  and  its  maximum  flight  time  is  'i.O  seconds.  It 
is  fiirlher  assinniui  tlial  I  be  missile  eiintains  a  sl:r;ip(!own  inertial 
navig.ation  syslcm  (liJS)  eonslsting  of  three'  acre le rome t (? rs  aitd  three 
rate  gyroscopes.  The  liJS  measures  outi)uts  of  actual  missile 
acceleration  in  the  body  frame  and  performs  a  coordinate  transformation 
to  get  tiie  accelerations  in  tiie  inertial  frame.  It  also  provides 
angular  rate  information  concerning  the  missile  heading  (f)  and  flight 
patii  angle  (0). 
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The  missile  Is  LLmlterl  in  th<;  iimount  nf  knowledge  It  has  at  its 

\ 

disposal  durine  and  after  launch.  Initial  aircraft  and  target  state 
estimates  .are  known,  with  some  uncertainty,  by  the  aircraft  .and  are 
passed  to  tl\e  missile  at  launch.  Once  tlie  missile  has  been  launched,  it 
continues  to  estimate  these  states  through  the  use  of  a  Kalman  Filter. 
The  missile  receives  ineasurements  of  aclinuth  (AZ)  and  elevation  (RL) 
angles  to  use  for  updates  in  tlie  flLt>.'r.  These  measurements  are 
obtained  from  a  grid  sensor  model  which  is  discussed  in  detail  In  the 
Me.asurenent  Model  section  of  this  chajiter.  A  gimballed  CO2  laser 
projector  on  the  aircraft  I'eneraues  .1  scanning  signal  whicli,  based  on 
the  time  between  scan  start  and  signal  reception  at  the  missile, 
determines  azimuth  and  elevation.  It  is  desired  not  to  encode  anything 
other  than  angle  information  onto  this  laser  signal.  Though  this  report 
is  concerned  only  with  the  single  target  case,  the  actual  system  has  to 
scan  and  track  multiple  targets  (up  to  10) .  To  encode  other 
information,  as  well  as  scan  each  target,  presents  a  very  burdensome,  if 
not  impossible,  task  for  tin*  aircraft  laser  generating  system  to  handle. 
Once  th.e  measurement  Is  obtained,  the  updated  filter  states  are  used  by 
the  guidance  law  to  generate  acceleration  commands.  The  proposed  states 
to  he  estimated  in  tiie  onho.ird  conpui cr  art;  discussed  further  in 
Chapter  III. 

The  missile  actuator  and  .lirfr.ime  attitude  dynamics  are  assumed  to 
be  well  represented  by  a  second  order  system.  In  other  words,  the. 
actual  missile  acceleration  is  nodded  as  a  second  order  response  to  tlie 
conn.anded  acceleration.  This  assumption  has  been  used  frequently  in 
missile  guidance  analyses  anti  is  con.sistent  with  the  level  of  modeling 
of  this  study  (Ref.  2). 

The  missile  is  assumed  to  be  a  point  mass  in  the  three-degree-of- 
f reedom  dynamics  development.  In  addition,  the  missile  velocity  vector 
and  tlie  longitudinal  body  direction  are  considered  colinear,  that  is, 
there  are  zero  angles  of  attack  and  sideslip.  This  assumption 
slmnlifies  the  dynamics  rlcvelopment  ;iiui  is  consistent  witli  Che  three- 
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dei’ree-of-f ree<,lom  nodeliap,.  Also,  rlio.  missile  m2  axis  remains  In  the 
horizontal  plane  throughout  th6>  ongagemont .  This  rol l-s tabl I 1 zat Ion 
assumption  simplifies  the  development  of  the  dynamics  (;c|uatlons  by 
eliminating  roll-axis  rotations.  Other  assumptions  are  discussed  in 
the  specific  Instance  to  which  they  apply. 

?  .  3  . '?.  Thri-e-Dcgree-of-Freedoin  Dynamics  Mociel.  The  state  equation 
which  model  the  missile  dynamics  are  developed  In  this  section.  Six 
equations  are  developed,  witli  the  necessary  states,  Inputs,  and 
parameters  defined  explicitly.  The  six  states  are 

xq  -  x‘|/oi  ll  component  of  missile  position 

^2  ~  yil/o)  io  component  of  raisslle  position 

X3  =  Z'l/o,  I3  component  of  missile  position 

=  V-f/o,  magnitude  of  Ch(!  missile  velocity  wrt  pt  0 

X5  =  iiilssile  heading  angle 
xf,  =  0,  missito  flight  path  angle 

In  addition,  variables  and  parameters  that  will  affect  the 
state  relationships  are 

T  =  missile  thrust 

V)  =  missile  drag 

m  -  missile  mass 

g  =  accelcr.'it  ion  due  to  g.ravity 

aj,  =  missile  lateral  acceleration 

an  =  missile  norcial  acceleration 

The  acceleration  liue  to  gravity  and  thrust  are  considered  constant 
The  acceleration  due  to  gravity  Is  tiie  standard  gravitational 


acceleration  of  32.17  ft/sec^.  it  is  assumed  constant  due  to  short 
flight  time  and  range,  of  the  eng.-iRoiient .  The  thruat  Is  also  assumed 
constant,  5000  lb,  for  one  second.  The  SiJeclfic  Impulse  of  5000  lb-sec 
generates  the  necessary  impact  velocity. 

After  one  second,  the  thrust  drops  to  zero  resulting  in  a 
boost-coast  Lrajectory  If  the  flight  time  i.s  greater  than  the  thrust 
time.  Mis.sile  drag,  mass,  lateral  acce ler.it i on ,  and  normal  acceleration 
are  variables  that  change  alth  time.  The  establishment  of  'nodels  for 
each  of  these  is  discussed  no'ct. 


The  drag  force  on  the  missile  is  (iief.  1:328)1 
D  =  y  pV=  SCp 

wh.ere 

p  =  density  of  the  air 
S  =  cross-sectional  reference  area 
Cf)  =  drag  coefficient 

n  velocity  of  the  missile 


(2-1) 


The  terms  p  and  S  are  constants  listed  In  Appendix  0.  The 
density  of  the  air  is  assumed  constant  since  the.  aircraft,  mis.sile,  and 
target  are  within  the  same  air  :nns,s.  Tiie  cross-sectional  area  Is  the 
reference  area  For  the  coefficient  c.f  dr.ig.  The  total  coefficient  of 
drag,  Cf),  is  defined  as 

-V  =  Cdo  +  ’3ur  (2-2) 

will'  re 

Cpo  =  coefficient  of  zero-lift  diMg, 
f.p£  =  coefficient  of  induced  drag 


"his  expression  can  also  be  'written  as 


o'l)  =  ''2nn  + 


2-'} 


■  ■IlnrrmMdKil— 


(2-3) 


wtiere 


K  =  iiiviTse  of  tho  partial  fii-rivat  1  ve  of  tlie  coefficient  of  lift 
with  respect  to  the  angle  of  attack 

Cl  “  coefficient  of  lift 

The  coefflrient  of  zero-lift  drag  Is  approximated  for  a  generic 
missile  by  (Ref.  5:22); 

2 

Con  =  — ^  (2-4) 

where 

M  =  "lissile  inach  number 

The  mach  number  of  the  missile  is  calculated  as 


where 

V3  =  constant  speed  of  sound 

The  coefficient  of  induced  drag  is  highly  dependent  on  aerodynamic 
c  ha  ru’ t  e  r  is  t  Ics  of  the  specific  mi,;;.slle.  Since  these  are  unavailable 
an  I  tlieir  inclusion  only  serves  to  cliange  missile  velocity,  thus  having 
minor  ■■fl.f.ct  on  filter  performance,  the  coef  f  Lcient  of  Induced  drag  is 
nugl  ec.  ted . 

The  mass  of  the  missile  changes  during  the  thrusting  portion  of  the 
flight  due  to  loss  of  f\iel.  The  li-'tal  missile  mass  is,  therefore, 
modeled  as  a  combination  of  the  mass  of  the  missile  and  tlie  mass  of  the 
fuel . 

m  =  m-.,  +  k  (tT-tp),  tp  <  tT  (2-6) 

or 

m  --  rm,,  t:  p  >  tp  (2-7) 


will!  re 


111  =  total  missile  mass 
'n\f  =  mass  of  missile  without  fuel 


k 


fflf 

tT 


jfuel  mass  depletion  rate  at  tp 


0 


nif  =  total  fuel  mass 

tp  =  elapsed  missile  flight  time 

tr  =  total  missile  thrust  time 


Thus  as  the  missile  thrusts,  its  mass  will  decrease  at  a  constant  rate 
until  burn  out.  The  mass  will  remain  constant  throughout  the  remainder 
of  the  flight. 


The  normal  and  lateral  accelerations  are  the  output  of  the 
ac  tiiator/a  i  rf  raine  attltud.i  dynamics  model  (Refer  to  Figure  2-2).  The 
attitude  response  of  the  missile,  due  to  acceleration  commands  from  the 
guidance  law,  can  be  modeled  by  a  second  order  system  (Ref.  2).  This 
lag  comes  from  delays  in  the  missile  actuator  and  rotational  dynamics 
to  change  the  angle-of-attaclc  which.  In  turn,  produces  the  actual 
lateral  and  normal  accelerations.  The  lateral  and  normal  accelerations 
are  generated  based  on 


2 

‘'ACT  '% 

actni  s2  +  2^  (0,-iS  + 


(2-3) 


where 

®ACT  “  actual  accelerations 
^CMD  “  commanded  accelerations 
(»>n  =  missile  natural  frequency 
C  =  damping  coefficient 
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The  details  of  the  computer  Implementation  of  this  transfer  function 
are  contained  in  Appendix  IJ. 

Once  the  actual  missile  acceleration  is  generated,  the  missile 
position  and  velocity  follow.  This  information  Is  necessary  to 
obtain  relative  information  between  the  aircraft,  target,  and  missile 
which  is,  in  turn,  applied  to  the  measurement  model  to  generate  azimuth 
and  elevation  angles.  These  angles  are  used  in  the  Kalman  Filter  as 
measurement  updates.  To  obtain  the  missile  position  and  velocity,  both 
the  Inertial  frame  and  the  missile  body  frame  are  used.  The  inertial 
frame  is  to  simplify  obtaining  relative  position  and  velocity 
between  the  aircraft,  target,  and  missile.  Missile  positions  are 
expressed  in  the  inertial  frame  in  order  to  compare  them  directly  with 
the  aircraft  and  target  position.  The  missile  velocity  state  equations 
are  defined  in  the  missile  body  frame  to  minimize  the  number  of  vector 
rotations,  since  all  aerodynamic  forces  are  collnear  with  the  body 
frame  axes.  Only  one  vector  rotation  is  needed  to  rotate  the  missile 
velocity  Into  the  inertia]  frame  for  position  state  equations.  Thougli 
there  are  many  methods  of  generating  state  equations,  using  inertial 
position  states  and  body  frame  velocity  states  is  then  a  logical  choice 
for  tills  application. 

Equations  for  misslLe  position  art.-  developed  by  defining  tlie 
missile  position  vector  in  tlie  inertial  frame.  The  derivative  of  tills 
vector  is  then  the  velocity  of  the  missile,  expressed  In  the  inertial 
'’rame.  The  velocity  of  tlie  missile  can  also  be  expressed  directly  in 
the  missile  frame  since  It  Is,  by  definition,  always  in  the  m]^ 
direction.  This  mi ss I le- f raine  velocity  is  then  expressed  in  the 
inertial  frame  by  a  coordinate  transformation.  The.  two  expressions  for 
the  Inertfal-frame  velocity  are  then  equated. 

The  equation  ‘or  missile  position  with  respect  to  point  "o" 
expressed  in  the  I  lertial  frame  is 


Taking  the  derivative  of  (2-0)  In  the  Inertial  frame  yields 


-M/o 


Vo  ^>1/0  ^2 


+  z 


M/o 


1.3 


(2-10) 


The  zero  angle-of-attack  assumption  allows  the  following  equation  for 
missile  velocity: 


^l/o  '"I 


(2-11) 


where 

Ym/o  -  mls.slle  velocity  vector  with  respect  to 

The  transformation  to  the  Inertial  frame  results 
aquation: 

-tVo"  ®  ^  ® 


Inertial  frame 


In  the  following 


A 

l2 


(2-12) 


Since  equations  (2-10)  and  (2-12)  are  equivalent,  the  missile 
position  state  equations  are 

^1  =  ^'!/o  =  V;i/o  cos  0  cos  T  (2-13) 

^2  =  TO/o  =  Vv^/<,  cos  G  sin  T  (2-14) 

^3  =  ^:i/o  =  -  Vm/o  sin  0  (2-15) 

The  state  equations  For  the  missile  velocity  are  developed  next. 

The  approach  for  a  clianging  mass  system  Is  to  use  (Ref.  6): 

„  ~  dV 

TF  =  m  +  Pi  Vt  -  Po  Vo  (2-16) 
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whoro 


i’  =  system  forces 
tn  =  variable  sj'stem  mass 
dV 

—  =  rate  cif  rhaaj^e  of  body  velocity 

”  rate  of  chariy;e  of  t!ie  Input  and  output 
mass,  respectively 

“  velocities  of  the  inptit  and  output  particles,  respectively 

For  this  nndel  is  zero.  The  thrust,  Vq  ,  and  Po  constant  and 

p.roiipof!  into  the  tilirust  component  of  tlie  forces.  Thus  equation  (2-16) 
reduces  to 


r.F  =  m 


dV 

dt 


(2-17) 


A  free  body  diagram  of  the  missile  is  set  up  to  Identify  each  of 
the  sy.'itim  forces.  These  forces  .are  then  .stiminod  vectorally.  Next,  the 
.aceel  era  (■  ion  of  tiie  missile,  as  seen  by  an  observer  In  the  inertial 
frame,  is  !iev(.' 1  opoii .  The  components  of  tiie  forces  .and  the  components  of 
accol ernt  ion  Limes  mass,  whicit  are  in  the  same  direction,  are  then 
ennated . 


The  missile  free  h.ody  diagram  is  Illustrated  in  Figure  2-4.  The 
forces  involved  are  the  thrust,  drag,  normal,  lateral,  and 
gt.avltai  ion-i!  forces.  Thrtist  results  from  tin;  boost  provided  by  the 
solid  propellant  notor.  The  later<al  force,  L2 .  fs  produced  by 
horizontal  plane  steering  commands  whlcli  generate  yaw  motion.  The 
normal  force,  b.j ,  is  the  result  of  pitch  movement.  Summing  these 
forces 

=  Tm|  +  L2  ’^2  ~  L;;  m3  -  Omi  +  rag  13  (2-18) 

Transforming  tiie  I3  component  by  use  of  the  direction  cosine 
matrix  from  i  to  m,  C"”’ ,  results  in  the  following: 

r?  =  (T-!)-nig  sin  0)  mi  +  L2ra2  ■*-  (mg  cos  0  -  L^)  n3  (2-19) 
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The  accel.erat  Lon  of  the  missile  as  seen  In  the  Inertial  frame  Is  derived 
by  taking  the  derivative  of  tije  equation  (2-11),  using  the  Theoro  of 
Coriolis 


id(vJi/„)  -na  (vj/,,) 


^1/ o  d  t 


where 


+  (wBli  X  V^/o) 


(2-20) 


^n/o~  defined  in  equation  (2-11) 


™d(  ) 


=  derivative  in  the  missile  frame,  m 


(1)™^  =  rotation  rate  of  the  missile  frame  witli  respect  to  the 
inertial  frame  (Appendix  A) 

Therefore,  coocdlnatizlng  tliis  in  the  missile  frame  yields 

■^l/o  “  %i/o  Q  '«!  +  0  ^2  +  '^  cos  0  ra3)  x  (2-21) 


=  '^M/o  '^M/o  ®  ■^2  -  0  m3 


(2-22) 


equating  col [near  forces  and  acceler.it Ions  results  in  the  following 
missile  velocity  state  equations: 


“  '^n/o  =  "  “  ^ 


X5  =  'F 


x6  =  e 


m  V  ,  cos  0 
H  /  o 


Ln  S  cos  0 
m  Vm/o  Vm/o 


(2-23) 


(2-24) 


(2-25) 


2-lb 


2. A  Aircraft  Model 


2.A.1  Assumption!!.  The  hypervelocity  missiles  will  be  deployed 
using  a  high  performance  aircraft,  sucli  as  an  F-16.  The  random  acceler¬ 
ations  of  this  type  of  aircraft  are  well  represented  by  a  first-order 
Gauss-Markov  model  in  the  Inertial  directions,  with  a  correlation  time 
constant  of  two  seconds  (Ref.  15).  The  aircraft  also  possesses  a  means 
of  target  acquisition  and  tracking.  This  system  identifies  the  target 
and  obtains  range  and  angular  position  information.  In  addition,  the 
aircraft  is  equipped  with  a  carbon  dioxide  laser  which  scans  the  area  in 
which  the  target  and  missile  are  located.  These  systems  are  discussed 
in  more  detail  in  tlie  Measurement  Model  section. 

2.4.2  Model.  The  aircraft  dynamics  are  modeled  by  inertial 
position  and  velocity  state  equations.  These  states  facilitate 
neasureinent  modeling.  The  aircraft  states  are 

A 

^Ai'o  ~  inertial  aircraft  position  in  li  direction 
y/,/o  =  inertial  aircraft  position  in  i2  direction 

A 

=  inertial  aircraft  position  in  I3  direction 

(V^/oJx  “  inertial  velocity  in  I3  direction 

t^A/oly  ”  inertia]  velocity  in  i2  direction 

[V^/o]z  =  inertial  velocity  in  I3  direction 
and  the  state  equations  are 


^\/o  = 

[  V  A  /  0  ]  X 

(2-26) 

II 

0 

< 

•  >^ 

[^A/o 1 y 

(2-27) 

^A/o  “ 

[’7a/o]  z 

(2-28) 

^’^A/olx 

[Aa/o!x  ”! 

(2-29) 
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f'^A/oly  “  [^A/oly  "2 

(2-30) 

t'^A/oJz  “  ['^A/olz  n3 

(2-31) 

vhere 

t'^A/olx*  [^A/oly.  [Aa/oJz  aircrafc  Inertial  accelerations 

*^1 1  '^2  >  ^3  =  inertial,  time-correlated 

Gaussian  noise  (refer  to  the  noise  model  section) 

The  inertial  accelerations  are  developed  from  the  application  of 
constant  accelerations  In  the  body  axes.  A  transformation  to  the 
inertial  frame,  using  tlie  direction  cosine  matrix,  develops 

i-^A/olx.  [AA/o]y,  '"'tid  [Aa/oIz*  A  planar  constant  turn  rate 
maneuver  is  generated  by  simultaneously  applying  a  constant  velocity  in 
the  direction  and  a  constant  acceleration  in  one  of  the  body 
axes  perpendicular  to  the  velocity.  Thus,  the  aircraft  has  the 
capability  of  flying  either  with  a  constant  acceleration  or  performing  a 
planar  constant  turn  rate  maneuver. 

2.5  Target  Model 


2.5.1  Assumptions.  Ground  vehicles,  for  example  tanks,  are  the 
types  of  targets  for  which  these  missiles  are  used.  Current  tanks  are 
capahle  of  turning  against  accelerations  of  fi.3  to  0.5  g's  (Ref.  3). 

M6n  tank  accelerations  are  wcll'-modcled  by  a  first-order  Gauss-Markov 
model  in  each  horizontal  direction.  The  correlation  time  constant 
associated  wi  tli  this  model  is  0.2  seconds  (Ref.  A). 

2.5.2  Moilel.  The  target  model  is  of  the  same  form  as  the  aircraft 
model.  The  states  are  Inertial  position  and  velocity  as  defined  below. 


xt/o  *  inertial 

target 

position 

in 

u 

direction 

yT/o  =  inertial 

target 

position 

in 

A 

i2 

direction 

zt/o  =  inertial 

target 

position 

in 

>3 

direction 
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f'^T/olx  “  Inertial  target  velocity  In  direction 


f'^T/o]y  =  inertial  target  velocity  in  ij  direction 
f^'T/olz  =  inertial  target  velocity  in  13  direction 
The  state  equations  are 


<-:/o  = 

f^T/olx 

(2-32) 

yr/o  = 

[VT/oly 

(2-33) 

=^1/0  = 

[^T/ol z 

(2-34) 

f^T/olx  = 

[  A'p  /  0 1  X 

n4 

(2-35) 

f^T/oIy  = 

[A'P/oly  ^ 

(2-36) 

f'^T/olz  “ 

(At/o!/,  -f 

'If) 

(2-37) 

whore 

[''t/oJx.  [At/oIv.  [At/o]z  =  nominal  inertial  target 

accelerations  (nominal  time  history  for 
simnlat  inn  i)\irpnses) 

*^4)  "^5  >  '^6  ~  inertial,  tirae-correlrited 

iiaussian  noise  (refer  to  floise  Model  section) 

The  state  equations  are  integrated  by  first-order  Kuler  integration,  as 
in  the  aircraft  moiiel,  since  the  equations  are  linear  and  the  target 
time  constant  of  0.?.  seconds  is  much  greater  than  the  integration  step 
size  of  .02  seconds.  The  tank  has  the  capability  of  standing  still, 
moving  wltli  a  constant  velocity,  moving  with  a  constant  acceleration  or 
performing  a  constant  turn  rate  maneuver.  The  maneuvers  are 
accomplished  in  the  same  manner  as  in  the  aircraft,  that  is,  a  constant 
velocity  is  applied  In  the  t-^  direction  and  constant  acceleration  is 
applied  in  the  tv  direction.  Thus  motion  of  the  target  is  restricted 
to  the  l]_ ,  {2  plane. 
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2.f>  Noise  Model 


Proooslny  stiapin^  filters  for  a  truth  model  Is  normally  based  upon 
extensive  data  analysis  to  determine  the  predominant  error  sources  and 
their  characteristics.  The  analysis  provides  autocorrelation  and  power 
spectral  density  'lata  for  which  a  mathematical  model  is  developed  to 
duplicate  or  at  least  closely  approximate  these  characteristics. 
However,  autocorrelation  or  power  spectral  density  data  for  the 
hypervelocity  missile  system  is  not  available  for  use  In  this  report. 
Therefore,  an  aggrej^ate  noise  model  is  used  in  the  truth  model  and  the 
error  sources  are  not  treated  individually.  The  missile,  aircraft,  and 
target  models  are  each  corrupted  in  their  body  frame  coordinates  by  a 
time-correlated,  first-order  Gauss-Markov  noise  added  at  the 
acceleration  level. 


Each  of  these  scalar  noises  takes  on  the  following  form  (Ref.  10:171- 
173); 


n(t) 


I 


n(t)  +  w(t) 


(2-38) 


where 


T  =  system  correlation  time  constant 
w(t)  =  zero  mean  white  Gaussian  noise  of  strength  Qf 
n(o)  •-=  0 

For  the  vector  of  scalar  noises,  this  Is 
n(t)  =  F  n(t)  +  G  w(t) 

where  ^  is  a  diagonal  matrix  with  elements 

and.  ^  =  I  ,thc  identity  matrix. 


(2-39) 


The  equivalent  dl.screte-time  model  is 


"(ti+l)  =  f(ti+l,ti)  n(tt)  +  wd(ti) 


(2-40) 
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where 


4'(ti+]^,tt)  =  the  state  transition  natrlx  tiiat  propagates 
from  tj  to  t^-fi 


iici(li)  ”  discrete-time  zero  mean  white  Gaussian  noise  of 
strength 


Since,  noise  nodei  dyriamics  are  t line- invar iant  and  the  .sample  period  of 
.02  seconds  is  short  compared  to  the  missile  time  constant  of  0.14  sec, 
a  first  order  approximation  for  the  state  transition  matrix  is  used. 

^(ti+l.ti)  =  I  +  F(ti)  [tt+i  -  ti]  (2-41) 


where 


_F(tj|^)  =  evaluation  sample  of  the  dynamics  matrix  at 
t  Ime  t 


In  addition,  a  flrst-ordor  approxi’.ii;i  i:  i  on  for  the  discrete-time  white 
Gaussian  noise  i.s 

LM  =  L'  'Jt  G'”'  tti+i  -  til  (2-42) 

where 


C  =  discrete  sample  of  the  dynamics  driving 
noise  coefficient  matrix 

Qfl  "  discrete  sample  of  th<!  strength  of  tlte 
“  dynamics  'Iriving  noise,  Q(. 

For  t)ie  .simulation,  it  is  deslri.-<i  to  generate  samples  of  the 
d  iscrete-tlme  wln'te  Gaussian  nol.se  process,  W(i(tO.  that  has  zero 
mean  and  covariance 


'■[Wd(tl)  wd^<’ti)]  =  Qd 


(2-43) 


This  Is  done  iislng  a  random  number  generator  which  generate.s 
Independent  samples  from  popuiatlonr.  of  independent  white  Gaussian 


n(ii.'?es,  wi  cli  kit-ru  nean  iii;!  .-(jv.jrianci?  of  identity.  Thus 

fiutocorrel  at  Ion 


K[wd'(ti)  Wf|"(t  j)'fl  = 


0  i^tj 


(2-44) 


Roforenre  ton  indicates  t)iat  Cho  truth  model  noise  can  be  generated  by 


«d(tl)  =  wd'Cti) 


(2-45) 


whore 


‘ty/  =  Cholesky  square  root  of  or  any  other  matrix 
.s’q<iare  root  iiiethod  of  Q(j 


To  show  that  this  s’.cneratos  tiu'  appropriate  cliaracter  is  t  i  cs ,  substitute 
equation  (2-45)  into  equation  (2-43)  to  get 


'"■[wdCti)  =  K(vSd'wd'(ti)  wd''(tl)V^l 


(2-46) 


Since  the  Q^j  terms  are  not  random,  they  can  be  moved  outside  the 
expectation  to  yield 

r-[w^(ti)  Wd"(ti)]  n[wa'(ti)  wd'(ti,)"]/ig  (2-47) 

Since  the  remaining  expectation  wan  di’fined  as  tlie  identity  matrix  by 
equation  (2-^4) 


!''[wd(ti)  wd^(ti)  ]  =  Q(! 


(2-48) 


which  is  the  s.imf!  as  c'quation  (2-43)  and,  tlierefore,  equation  (2-45) 
generates  tlie  d  i  sc  re  t  e-t  ime  noise  v>;iLh  desired  chracteristlcs  . 

(Ref.  10:408) 


V  ,  .  . 


The  values  for  are  obtained  by  '•i' if orml njj  i\  steady  state  analysis  on 
the  system's  conditional  covariance  matrix,  V>(t).  Vor  the  linear, 
contlnuons-tlme  system,  steady-stat<-  performance  refjulres 


■P(t)  =  F  P(t)  +  P(t)  fT  -f  G  Q  GT  =  0 


(2-49) 


1,'slnp  the  firs!  order  approx  t  mat  (on  "Iven  liy  e'|iiatif>n  (2-42)  and 
suhstltntlnp  into  (2-49)  yields 


oho  re 


iid  -  “  £s.s  [li+1  -  ti  l 


J^ss  “  steady-state  covaj'lance 


(2-50) 


r.qviation  (2-50)  can  also  he  written  as 


Qd  =  -^  fy-  f  4+1  -  ti  ] 


(2-51) 


whore 


a  =  standard  deviation 


“he  retiulred  simulation  noise  parameters,  o  and  x,  are 
summarized  in  Table  2-1.  These  two  parameters  provide  all  the 
information  needed  for  the  simulation  to  use  equations  (2-40),  (2-45), 
and  (2-51).  The  aircraft  is  a  high  performance  vehicle  and  the  target 
is  a  tanh.  The  values  us(!d  for  x  and  a  are  typical  numbers  that  are 
representative  (if  tiiis  class  of  problem  (Kef.  4,  il).  Since  there  is  no 
data  to  Indicate  niherwlse,  the  correlatl(3n  time  constants  are  assumed 
equal  in  all  thrije  d  i rec  t  iijns  . 


mul.ition  Statistics  for  Target,  Aircraft,  aini  .lissile 


2.7  'It'a'Sviroi'KMit;  'loflel 


A  m.TtViem.it;  1  cal  noiU*]  tor  azlamth  (A.I)  and  elevation  (EL)  Is  next 
developed  as  a  neasureaient  Lu  the  filter  update.  AE  and  EL  are  angles 
that  describe  lalsslle.  position  relative  to  the  atrcraf t-to-target 
1  ine-of-r,  ight  (Figure  li-S).  As  rient  toned  in  tlie  Aircraft  Model  section, 
ttie  aircraft  has  a  target  tracking  system  which  acquires 
aircraf t-to-targ(}t  range  and  target  position  information.  The  aircraft 
also  tii>;  a  laser  that  scans  the  area  in  wlilcli  botlt  the  target  and 
missile  are  located.  The  missile  is  captured  witltin  tl'.e  laser 
f leld-of-vi ew  shortly  after  launch  and  the  target  is  always  centered 
wittiln  the  laser  scan.  Clocks  on  both  tlie  aircraft  and  missile  are 
initialized  at  launch  and  assumed  synchronized  throughout  tlie  flight  of 
the  missile.  The  missile  assumes  tlsat  the  aircraft  precisely  performs 
Its  function  of  centering  t’ne  target  on  the  laser  scan  ftel  d-of-view. 
^ased  upon  this,  the  missile  develops  a  grid  model  of  the  process 
oerformed  by  the  -ilrcrafc  (Figure  n-S)  . 

The  missile  is  aware  of  how  many  vertical  scans  the  laser  makes 
during  a  certain  amount  of  time,  with  each  vertical  line  on  the  grid 
corresponding  to  one  vertical  sweep  of  the  laser.  The  laser  signal  is 
received  hy  a  tall-mounted  sensor  on  the  missile,  with  the  total  time 
frrim  scan  start  to  tlie  monent  of  reception  being  the  factor  that 
determines  the  location  of  the  missile  on  the  grid.  From  the  grid 
locations,  the  missile  thus  has  a  measurement  of  a;:imi,ith  and  elevation. 

Associated  with  the  measuremenl  of  azimuth  and  elevation  are 
uncertainties.  Tracking  the  targi-t  and  centering  it  within  the  laser 
scan  lias  uncertainty  associated  with  it.  Also,  the  timing  process 
whic.h  sots  up  the  missile  grid  model  also  contains  uncertainties.  The 
combination  of  these  uncertainties  is  accounted  for  in  the  measurement 
model  by  the  addition  of  a  zero  mean  white  Gaussian  noise  of  strength 
in-f>  rad2. 
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Figure'  2-5.  La.sor  Grid  Scan  and  measurement 
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The  alrcraf t-to-targeC  I irie-of-slght  fra<ae  and  the  Inertial  frame 
components  are  used  to  generate  truth  model  AZ  and  EL. 


(projection  of  onto  £2) 

(Im/a) 


-  (projection  of  _rj.i/A  onto  ij) 


(in/a) 


(2-52) 


(2-53) 


The  projections  onto  lo  and  £3  are  found  hy  transforming  the 
rnissilo-to-al  rcraf t  relative  position  from  inertial  to  llne-of-slght 
coordinates  and  cliooslng  the  appropriate  components. 

Using  the  direction  cosine  matrix,  [C^i] ,  In  conjunction  with 
the  position  of  tiie  missile  with  respect  to  the  aircraft,  _£j.(/a, 
where 


-M/A  ■  i2  +  2M/A  ^3 


(2-54) 


[€*•1]  =  inertial  to  alrcraf t-to-misslle  llne-of-slght  transformation 
matrix  (Appendix  A) 

produces 


4i/A  =  (^1/A  \  ^'1 

+  (-x^./^^  sin  cos 

+  (>>.,/A  ■‘'z'  '4i/A  '‘'l  N/A  *-“3 

(2-55) 


The  angles,  Oj^  and  Tj;,,  are  not  known  yet  and  must  be 

specified.  This  is  done  by  first  defining  target-to-aircraf t  relative 
position  as 

-T/A  °  h/\  (2-56) 

where 


^'T/A  "  ^’'t/A  ^T/A 


f/A 


)l/2 


(2-57) 


Then,  since  =[Ci*-)5’ 


’'T/A 

Rt/a 

yT/A 

0 

’'T/A 

0 

(2-53) 


Performing  this  oporition  r<!sn1ts  in  three  onuatlons  and  three  unknowns. 


,  =  R  ,  c’os  0^  COE  t 

T/A  T/A  1  1 

(2-59) 

”  R-r/>  COS  sin 

T/A  t/a  i  ?, 

(2-60) 

T/A  t/a  e 

(2-61) 

Fron  equation  (2-61) 

and  from  eq\iation  (2-60) 
'*1  =  sin~^ 


yT/A 

"t/A  cos  Gd 


(2-62) 


(2-63) 
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The  equations  for  AZ  and  oL  are  thus  completely  specified  by  the 
f  ol  lowing: 


-’'M/A  sin  '‘It,  +  yM/A  cos  i 

kT.  =*  sln*^ - r-T;r 

^  •?  .  •>  .  ^  1  ^ 
(xM/A  +  yii/A"  + 


(2-64) 


KI.  =  sin“^ 


-(x  ,  sin  0  cos  +  y  ,  sin  0  sin  f  +  Z  ,  cos  0  ) 
M/A  i  I  >I/A  ^  i.  M/A  I 


(xm/a'^ 


XM/A' 


+ 


ZM/A  ) 


2. ITT 


(2-65) 


2.8  Guidance  T.aw 


The  guidance  law  accepts  information  concerning  target  and  missile 
relative  dynamics  and  generates  acceleration  commands  to  direct  the 
missile  to  tlie  target.  The  major  guidance  laws  that  are  presently 
appTicalilo  to  short-range  tactical  missiles  are  discussed  in  Reference 
8.  A  coinpreiions  I  ve  !ii hliograpliy  has  also  been  included  in  tliis 
reference  which  readers  can  use  for  more  in-depth  study  into  the 
analysis  of  various  guidance  law  schemes.  The  major  guidance  laws 
examined  are  line-of-sight ,  pursuit,  proportional  navigation,  optimal 
linear,  and  others.  The  last  category  Includes  proposed  guidance  laws 
based,  primarily,  on  differential  game  theory.  These  laws  are  still  in 
the  very  early  research  and  development  stage  and  are  not  considered  for 
possible  implementation  in  this  stvidy.  The  first  three  are  classical 
guidance  laws,  whereas,  the  fourth  Is  a  modern  technique.  Line-of-sight 
guidance  can  he  furtlier  divided  into  two  laws  which  differ,  primarily, 
in  how  th<'y  are  applied.  These  are  he.imrider  and  command  to  line-of- 
sight.  The  command  to  line-of-sight  scheme  typically  U!:es  a 
communications  link  from  a  controller  to  the  missile.  The  controller 
Cracks  the  missile,  generates  a  line-of-sight  to  the  target,  and  sends 
guidance  signals  to  the  missile.  The  beamrider  concept,  however,  does 
not  use  a  controller  to  track  the  missile.  An  air  or  ground  station 
provides  a  11 ne-of-slght  to  the  target.  The  missile  requires  knowledge 


of  its  position  relative  to  the  lino-of-slght .  Tt  obtains  llne-of-slght 
information  through  a  coianiuni  oat  i  ons  link  v/ith  the  controller  and 
computes  its  position  relative  to  the  line-of-sight  based  on  Initial 
condition  at  launch.  Pursuit  guidance  employs  the  technique  of 
continually  trying  to  keep  the  missile  pointed  at  the  target.  There  are 
two  basic  variatlnn^?  in  this  method.  The  first  is  attitude  pursuit 
where  the  nissile's  long! tiullnal  axis  is  directed  at  the  target.  The 
other  is  velocity  pursuit  wliere  the  missile's  velocity  vector  is  kept 
pointed  at  the  target.  Velocity  pursuit  exhibits  much  better 
performance  than  attitude  pursuit,  in  terms  of  average  terminal  miss 
distance.  Proportional  navigation  is  a  guidance  scheme  that  attempts  to 
null  the  tnissi le-to-target  line-of-sigbt  rate,  while  closing  in  on  the 
target.  This  puts  tiie  Tuisslle  on  a  collision  course  with  the  target. 
Optimal  linear  guidance  is  based  upon  optimal  control  theory.  Almost 
all  of  tlie  work  in  this  area  Is  based  on  linear  model  dynamics, 
quadratic,  costs,  and  additive  white  Gaussian  noise  (LQG  problem).  It  is 
I  mplomen  t('<I  with  an  hQG  cont  rol  I  or  and  a  Kalman  Fllti.-r  tliat  generates 
state  estimates. 

Classical  proportional  navigation  is  the  guidance  law  selected  for 
this  study.  The  target  is  an  armored,  ground  vehicle  which  will  be 
stationary  or  moving  with  a  near  constant  velocity.  For  this  type  of 
target,  proportional  navigation  has  characteristics  which  favor  it  over 
the  other  schemes.  Proportional  navigation  cxViibits  much  better 
terminal  miss  distance  performance  than  does  pursuit  guidance  for 
targets  moving  with  an  acceleration  less  than  0.5  g's.  Under  these 
same  conditions,  llne-of-sight  guidance  iias  a  miss  distance  on  tlie  same 
order  as  proportional  navigation;  however,  to  implement  it  requires  a 
complex  controller,  either  on  the  aircraft  or  on  the  ground. 

Proportional  navigation  also  has  a  nucli  quicker  reaction  time  and 
expends  mucli  loss  control  energy  in  trying  to  reacli  the  target.  Thus, 
airframe  and  propi;]sion  requirements  are  not  nearly  as  stringent.  For 
highly  maneuverable  accelerating  targets,  optimal  guidance  laws  are 
superior  to  other  laws  in  terms  of  miss  distance  performance. 


However,  a  mterocompiiter  is  neeHerf  onboard  the  missile  for 
computational  purposes.  This  significantly  increases  the  complexity  of 
the  system  as  well  as  creating  more  implementation  problems.  Since  the 
target  Is  not  highly  maneuverable  and  the  Increased  onboard  complexity 
is  not  desired,  proportional  navigation  is  more  applicable.  (Ref.  13) 

The  proportional  navigation  law  commands  a  missile  turning  rate 
which  is  proportional  to  the  rate  of  change  of  the  rnissile-to-target 
I Ine-of-sight  angle  (X,  refer  to  Figure  2-6).  The  defining  scalar 
equation  is 


’CM!)  =  n  V’c  X 


(2-66) 


where 


n  =  proportional  navigation  constant 

Vc  =  closing  velocity  along  the  1 Ine-of-sight 

X  =  1 1 ne-o f-sight  angle  rate 


Equation  (2-66)  can  be  extended  to  the  vector  case  by  simply  using  the 
appropriate  component  of  the  misslle-to-target  line-of-slght  rate 
vector,  t^L0S>  instead  of  X. 

The  closing  velocity  is  the  component  of  the  velocity  of  the 
missile  with  respect  to  the  target  along  the  roissl le-to-target  llne-of- 
slght.  This  is  computed  by  applying  t'ue  dot  product  between  the 
velocity  vector  and  a  unit  vector  along  the  miss  1 le-to- target  Itne-of- 
s ight . 

That  Is 


Vc  =  [vI/mI 


(2-67) 


using  tlie  expresstons 


-T/M  "  ’'t/m  ^1  ^T/M  ^2  ■*■  \/'-l  S  (2-68) 

-T/M  "  ’'t/m  ^  ^  ^T/n  h  \/M  S  (2-69) 

yields 

(Xt/,^)  (y.r/[^)  +  ^^T/M^  ^^T/M^ 

V  - - ; - 

/.-  2  +  V  2  h  -  2)1/2 

^''T/M  ^T/M  T/H  ‘  (2-70) 


The  following  development  derives  an  expression  for 
Relating  JV'p/r.f  between  the  k  frame  and  i  frame,  via  the  Theorem  of 
Coriolis,  results  in  the  following  equation: 


-T/M 


=  - Ll1_  =  - LL!!-  +  (u)lo  X  r  ,  ) 

M  dt  dt  -  -nw 


(2-71) 


where 


-T/M 

'"-‘’(It/m) 


dt 


missile-to-target  relative  position 


rate  of  change  of  _r  f/n  as  observed  from 
tlie  1 1  ne-of-sight  frame 


[okl  =  rotation  rate  of  the  k  frame  with  respect  to  the 
inertial  frame 


Since  k)  is  defined  to  point  In  the  direction  of  the  missile-to-target 
line-of-sight  and  the  tc  frame  rotates  with  the  line-of-sight ,  the 
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rotation  rate  of  the  mi  ns  I  Le-to-tarj;et  liiie-of-sight  vector,  u)  ,  Is 

^  ’  -MTLOS 

equivalent  to  the  rotation  rate  of  the  llne-of-slght  frame  with  respect 
to  the  inertial  frame,  Performing  the  cross  product  of 

with  both  sides  of  equation  (2-71)  results  in 


r  ,  X  ,  =  r  ,  X 

-T/M  -T/M  -T/M 


’<^d(r  ,  ) 
-^r/M 


dt 


+  r  ,  X  (mhi  x  r  ,  ) 
-T/M  -  -r/!-r 


kd(r  ,  ) 
-T/M 


where  the  expression  r  ,  x 


■T/M  dt 


(2-72) 

,  is  zero  since  both  terms  lie 


along  the  ralssile-to-target  llne-of-slght.  The  triple  cross  product 
rule  is  defined  by  the  following  equation: 


A  X  (B  X  £)  =  ( A  •  C)  -  (A  •  R)  C  (2-73) 

Applying  this  to  equation  (2-73)  results  in 

^/M  ’'-T/M  "  ^-T/M  "  -^/M^  -MTLOS  ~  ^-^/M  '  -MTLOS ^  -^l/T  (2-74) 


The  mlssile-to-target  line-of-sight  roll  stabilization  assumption 
allowed  the  selection  of  coordinate  directions  so  that  the  term 


r  , 
-T/H 


(!) 

-MTLOS 


Is 


zero* 


Thus,  final  fora  for  the  line-of-sight  rotation  is 


Therefore 


<^TLOS 


(,h)ii  +  (M)i2  +  (N)i3 

(x2  +  ,  +  z2  ) 

T/M  T/M  T/M 


(2-76) 


where 


L  =  (yi/’i)  (zt/m)  -  (zt/m)  (yx/M) 
M  =  (zt/m)  (xt/m)  ~  (xT/m)  (zt/M) 
N  =  (xt/m)  (yi/M)  “  (yx/M)  (xt/m) 


Thus,  the  guli,lance  law  is  completely  specified  with  the  various 
components  of  tlie  equations  being  estimated  states  or  parameters 
depending  on  tlie  type  of  filter  developed  in  Chapter  III. 

«• 

2.  .9  Summary 

Truth  models  of  the  actual  aircraft,  missile,  and  target  engagement 
scenario  were  developed  in  this  chapter.  The  models  Include  dynamics, 
a  guidance  law,  and  a  measurement  eqxjation.  The  next  step  is  to  design 
a  Kalman  Filter  which  v;ill  accept  azimuth  and  elevation  measurements 
f roiii  the  truth  model  and  generate  state  estimates.  These  estimates 
inform  the  missile  of  its  position  and  velocity  relative  to  the  aircraft 
and  the  target.  They  arc  then  applied,  along  with  INS  estimates,  to 
the  guidance  law  to  direct  t'le  missile  to  the  target.  The  design  of 
this  filter  is  the  topic  of  the  next  chapter. 


2-35 


III.  Kalman  "i.  ICer  Oe  vc  lopmoiit 


3  . !  r:if:  rodur  r  i  on 

3.1.1  ^pproncti.  The  Kalman  llltei  is  a  (lipltai  nonputer  alj’or  i  thm 
which  uses  the  i'.vailahle  r]  iscrete-i  l  to  nnj.sy  neasurements  to  estimate 
certain  le.gired  variables.  Since  :  hi-  analysis  considered  only  the 
vertical  plane,  elevation  was  the  only  anp,le  mcasuti'ment  reqviired.  The 
Kalman  Filter  processed  this  measureiient  and  estimated  relative 
Information  between  Cite  .aircraft,  missile,  and  target.  This  chapter 
iroiitains  a  systen.ttir:  procedure  in  developing  full  order  and  reduced 
order  filters.  The  full  order  fiit-r  performance  was  to  be  used  as  a 
benchmark  to  which  reduced  order  filters  are  compared.  Selection  of  a 
reduced  order  filter  for  actual  Imj)  i.^inentation  was  a  trade-off  between 
performance  <ind  on-board  complexity. 

Filter  development  first  consisted  of  proposing  models  upon  which 
filter  design  could  bo  based.  The  approach  for  each  filter  model  was  to 
initially  propose  a  set  of  state  v.'.i  iables  based  upon  kinematic 
r  cl  at  ionslil  ps  .  State  equations,  whirl)  contain  both  determinist  Ic.  and 
stochastic  elements,  were  then  developed.  A  measurement  equation  was 
derived  from  the  geometry  of  the  e.i;',.iv,ement  and  expressed  in  terms  of 
the  ut.iti's.  Tn  adrlit.  'o,  the  g.u  i  .l.iu-e  l.tw  must  hi'  a'lle  to  perform  its 
function  using  t!ie  state  cstliii.'ites  end  launch  data  extrapolations. 

Sneclfir  states  were  thus  added  b.is.i.i  upon  the  requirements  of  the 
guidance  lav^  and  tin'  measurement  none  I.  Motiels  tliat  ■■how  the  most 
promise  for  implementation  wore  thci  selected  and  developed  further. 

"our  separate  filter  design  models  .ere  derived.  Two  of  tho'je  models  were 
based  upon  polar  coordinates  .and  the  other  two  were  based  upon  cartesian 


coor.'!  i  na  tps .  Two  of  thoKc;  four  models,  one  cartesian  and 

one  polar,  were  t’ncn  selected  for  ivtter  Jevelopnenr.  and  analysis. 

3.1.2  Filter  Mode!  .Ic  loct  ton  ■  Due  to  the  time  limitation  on  this 
study,  only  two  of  the  four  flltei'  ••utols  were  selected  for  further 
analysis.  Sinci'  tliere  were  two  ha.:-!-  forniulatlon  methods,  LOj  and 
Iru'rtlnl,  till'  initial  decision  was  i  •>  choose,  one  of  lach.  Filter  model 
I, .  1  'vas  selecled  from  the  I.OS  chiiii  -s.  Tlie  I,. I  'node  1  was  hased  upon  th 
ATI.OS  frame  ai  a  refereiice.  On  t  lu  other  hand,  the  1..2  model  was  based 
upon  tile  MThOS  ‘'rame  as  a  referenn  .  The  ATLOfl  frame  was  much  less 
dynamic  than  tlie  ifl'LOtl  frame,  thereiore,  numerical  'problems  are  less 
likely  to  appear. 

Filter  muih.'l  l.l  is  the  inert!  :1  frame  formulation  selected  for 
filter  desiftn  and  analysis.  This  model  used  ai rcraf t-to-target  and 
m i  ssi le-to-target  states.  The  cor:-":;pond ing  measurement  equation  and 
guidance  law  depend  only  on  state  r  1 1 i ma tes .  The  1.2  model,  however, 
estimates  inertial  aircraft  and  tai.pit  states.  The  missile  variables 
were  assumed  known  through  high  quaticy  IKS  data.  However,  the 
hypervelocity  missile  was  designed  r.o  be  very  small  so  that  many 
missiles  can  be  deployed  on  each  aii\;raft  and  the  missiles  were  to  be 
relatively  inexiicnsive  -since  they  .'.e  destroyed  upon  impact. 

Therefore,  the  requlreiaent.  for  IKS  uata  was  not  desirable  since  a 
Ii  iyh-q  u.i  1  1 1  y  f'S  is  lioth  expensivo  oid  bulky. 

3.1.3  Observabi  1  i  ry .  For  an  -  ;iroposed  model,  ohservabili  ty  was  a 
key  issue.  To  he  co.npli'tely  obser  .ifde  any  ch.inge  in  an  individual 
state  variable  must  be  d i s t i ngui shahl e  to  the  output  measurement.  In 
addition,  any  change  in  a  Part icul' ;  state  variable  must  be 

d  i  s  t  i  nypi  Isha’ol  I'  in  the  out  put  from  a  change  in  any  other  state  variable 
In  the  case  of  a  Kalman  Filter,  tlu  measurement  update  should  have  a 
d  f  St  i  ngii  f.shablc  effect  on  each  of  the  slates.  Also  for  a  completely 
observable  system  the  covariance  wiM  not  grow  unbounded. 


An  nb.si;r^/.:iln  !  i  ry  .ni.i  ly.s  I s  wan  purformed  on  each  of  the  selected 
full  order  and  reduced  order  filter  riudels.  The  discrete-time 
ohservabl  llty  matrix  for  L  Line-inva .  iant  linear  systein  models  was 
constructed  as  follows: 

A  . 

M  =  [U^T  .  4,T  ][T  .  .  ...  /.{.T)!!-!  jj^T] 

(3-1) 

where 

i  =  state  transition  matrix 

I!  =  nensuremont  model  coefficient  matrix 

The  system  is  fully  observable  if  tiie  tiatrix  M  is  of  rank  eqtial  to  the, 
state  dimension.  (Ref.  10:47) 

3.1.4  Assumptions.  For  most  of  tlie  models,  thi'  missile  was 
assumed  to  liavo  an  INS,  wiiich  provides  missile  total  accelerations  in 
the  Inertial  fraiie: 

AiN'S  ”  11+  a3  ii  (3-2) 

In  addition,  t’ne  INS  provides  inert  ial  velocities,  ^i/o  'RI/oj 

and  positions,  and  z:i/o>  V  irfejiration  of  the  ^accelerations . 

These  are  assumed  to  be  hip,h  <iualiiy  data  and  are  used  as  parameters  in 
the  measurement  model  and  guidance  law,  as  opposed  to  noise-corrupted 
measurements . 

As  discussed  in  the  truth  model,  the  aircraft  obtains  measurements 
of  its  range  to  tbe  target.  The  aircraft  also  contains  an  INS  which 
generates  information  of  inertial  accelerations,  velocities,  and 
positions.  The  INS  information  is  passed  to  the  missile  at  launch  and 
then  propagated  by  the  missile  base:!  on  constant  aircraft  and  target 
acceleration  assumptions . 


Tht'.re  arc  two  methods  used  to  ocoeess  the  alrcraf t-to-target 
range.  For  the  ] ine-of-s ight  Filter,  the  range  was  passed  to  the 
missile  at  launch  and  subsequently  estimates  within  by  the  missile. 

This  metliod  was  ruled  out  for  the  inertial  filter  due  to  observability 
problems  not  exhibited  by  the  LOS  i Liter.  To  obtain  a  fully  observable 
inertial  benclvnark  model,  the  alrcraf t-to-target  range  and  the 
ID  iss i le-to-target  range  are  needed  as  measurements.  The  ranges  were 
conpiiti'd  by  the  iiiisslli',  wltli  addetl  uncertainties,  and  applied  as 
p soi!do-moa.''uri't;ii'n  1; •;  to  the  filler. 

3.2  'Vj velopmo n t  of  Lino-Of-Sight  !  i  iters 

3.2.1  In t roduc t ion .  The  filters  developed  in  this  section  focus 
on  equations  of  motion  expressed  In  polar  coordinates.  This  coordinate 
choice  makes  tiio  equation.-?  of  motio-  nonlinear  due  to  the  rotation  of 
tlie  reference  frame.  The  equationr?  developed  here  For  the  full  order 
filter  will  .al  s.n  apply  to  the  redur.-d  order  filters,  i-rhile  sotne  of  the 
variables  in  the  full  order  filter  are  not  used  as  states  In  the  reduced 
order  filter,  they  are  propagated  in  time  and  treated  as  parameters  In 
the  filter  and  guidance  law  computations.  The  filter  then  assumes 
perfect  knowledge  of  these  parameters  in  this  case.  Pseudo-noise 
addition  via  tuning  then  accounts  f-?r  the  fact  that  these  are  not 
equal  to  true  parameter  values,  h'lth  development  in  general  form,  the 
equations  can  be  used  directly  to  construct  any  of  the  reduced  order 
filters . 

3 .  .2 . 2  Filter  Mod  el  L .  I .  The  equations  of  motion  for  this  filter 
are  expressed  in  polar  coordlnate.s  based  on  the  ATi.OS  line-of-sight 
reFerenc<>  frame  witli  the  ori;’In  remaining  on  the  target.  The  state 
variables  clioson  are  Lliustrate<l  in  Figure^  3-1. 
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The  state  variables  are  doftnecl  as 

;;  -  hlstanee  or  MSL  below  A/C-  I  J-TCT  bOS 
7.  =  Velocity  of  Milb  from  A/C-T)-TflT  LOS 

%/T  =  MSL-TO-TGT  raoge  along  LOS 
Rm/T  =  ilSL-TO-TCT  velocity  along  ;,0S 

Qg,  =  elevation  of  tlie  LOS  with  respect  to  horizon 
R/^/T  =  A/G-T0-T(.'T  range  along  LOS 
'^A/T  “  A/C-TO-TGT  velocity  along  j.OS 
And  as  a  retiulred  parameter; 

=  rate  of  change  of  LOS 

The  term  can  he  included  as  a  state  variable  under  certain 

circumstances,  but  is  more  correctly  treated  here  as  a  parameter.  The 
coordinate  frame  as  discusaed  (n  Section  2.2  is  right-handed  with 
along  the  ai  rc  ra  f  t- t<i- tar<'e  t  1  i  ne-of-slglit  •  The  reference  frame  is  roll 
stabilized  wiuli  £2  along  tlie  liorlzontal  plane  and  £3  downward 
completing  tlio  triad. 

In  deriving  the  equations  of  niotlon,  let 
u«.i  =  -  osj  £2  (3-3) 

Og  =  0^  £2  (3-4) 

and 

i>l/T  =  R’i/T  +  z  ^3  (3-5) 

The  velocity  of  tlte  missile  can  bo  obtained  by  taking  the  first 
derivative  of  _tji/’T  in  the  9.  frame  with  respect  to  the  Inertial 
frame  as  defined  by 

,  ^d  *'d 

,  =  —  r  ,  =  —  r  ,  +  x  r 

-T1/T  dt  -M/T  dt  -M/T  -  -  M/T  (3-6) 


3-6 


Which  in  terms  oF  the  state  variables  gives 


L  •  ,  A  (3-7) 

V_M/T  =  («M/T  “  2  +  (+2  ^  vl/T  W|t)i3 

A'VTln,  taking  the  derivative  oi  velocity,  using  the  Theorem  of 
Coriolis,  the  acceleration  Is  exprtrssed  as 


id 

—  V' 
dt  -M/T 


—  Vi  ,  -I-  u)^i  >:  Vl  , 

dt  -M/T  -  -M/T 


which  yields 


(3-8) 


"^M/T  “'i 


d-(z  +  m..  -  ;.a)2 

2 

In  the  tra  jectory  considered,  :;lie  w  and  u)j{,  terms  were  found 
to  he  less  than  2  percent  of  the  larger  terms  and  arc  considered 
neglible  for  the  purposes  of  this  dc 'elopment .  Howe-’er,  they  were  used 
in  tlie  filter  equations  Initially  completeness. 


The  outputs  of  the  IMS  were  c<  i'.sidered  to  he  lilgh  quality  noise- 
free  estimates  of  the  missiles  total  acceleration  expressed  in  inertial 
frame  coordinates  and  expressed  as: 

iSi  *  ^‘1  ’'i  +  ‘•’2  i2  +  aq  i3 

The  outputs  of  ti'o  li'hS  \/cre  then  rnfated  into  the  i  "■'aine  Appendix  A. 


AV  =  (a,  cos  0^  -  a^  sin  0^)  +  a^ 


(3-11) 


+•  (aj  sin  Qi  +•  a^  cos  G^)  ^3 


The  total  acceleration  of  the  missile  witli  respect  to  the  target 
Is  the  difference  of  the  missile's  total  acceleration  and  the  target's 
total  acceleration.  However,  sincr  the  missile's  accelerations  are 
much  greater  than  those  of  tlie.  target,  the  relative  Ttilsslle-to-target 
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A? 


accelerations  can  be  approximated  by  the  ratsslle's  total  accelerations. 
This  assumption  will  permit  equatlnp,  ^  in  equations  (3-9)  and  (3-11)  and 
grouping  the  vector  components  to  yield: 


z  =  -2  (i>g,  +  aj^  sin  Qi  *■  33  cos  0t 

-  ^.,/T  ti)j+  2  u)2 


(3-12) 


"n/T  =  ^  'N/T  %  “  ^2  "3 

(3-13) 

The  expressions  for  and  a)£  are  <!.’i;-;nd  as 


Ojl  = 


lA/T  Va 
,,^1  =  - 


(3-14) 


(3-15) 


where  for  the  planar  problem  wj  =  lo^li 

The  velocity  of  the  aircraft  can  bo  expressed  in  polar  form  as  Va 
at  an  angle  of  9a  above  the  horizon.  If  expressed  in  the  LOS  frame 
the  aircraft  velocity,  Va  /0a,  becomes  Va/t  M  + 

A 

Va  tan(0)i  -  0a)  1^3  where  Va/t  and  0f_  are  states  and 

©A  if*  assumed  a  constant.  With  this  substitution,  equation  (3-15) 

becomes : 

<h/Th'  ”  ^\n  *'  *  h/i  -  ®aI'3) 

(0)^  a - 

p  /  2  (3-15) 

^A/T 

which  reducc?s  to 


-  V^^/.p  tan  (On  -  0a)  ^ 

“i  = - s-it: - 


(3-17) 
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N'oto  Lli.it  tlie  fxi)i‘i!ss  ion  For  uj  can  [ic  expri-sserl  as  a  function  of 
three  other  states.  In  the  case  oF  the  full  order  f  liter,  a»;  Is 
computed  as  a  parameter  v#here  needed.  However,  for  th.e  reduced  order 
filter  where  any  of  t)ie  three  varlaMes  needed  for  are  not 
states,  (Dj  can  Itself  be  considered  a  potential  state  choice  arid 
can  be  obtained  by  taking  the  derivative  of  0j. 

Taking  the  derivative  of  ojj  can  he  simplified  by  using  equation 
(3-20)  anrl  tke  approximation 

^'a/T  =  Va  cos(0j  -  0a)  (3-18) 

where 

Va  =  t)\e  magnitude  of  the  A/O  velocity 
Va  =  0  is  assumed  in  this  str.dy 
Vq’  =  0  is  assumed 

Then  wn  becomes 


2 

-  Va/T 


tan(0ji  -  0a) 


(3-19) 


A3  terniitively ,  w  can  be  obtained  in  the  simulation  by 

«  f'i)i(ti.t-i)  -  m)j(ti)]/(ti  +  i  -  ti)  (D-'^O) 

since'  the  rate  of  change  of  W£  will  be  small  and  relatively  constant. 


The  aircraft  accelerations  wer<?  obtained  in  a  similar  fashion  as 
that  of  the  missile  except  without  ttie  INS  inputs.  Tlten  the  derivative 
of  aircraft  line-of-sight  range  yielding: 


R  =  V 
A/T  A/T 


(3-21) 
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Al'pl-y i!i>!  f'-He  Theore;ii  of  Coriolis  to  yield 


+2  i- .  u)  t- 
A/T 


'^A/T  “a  ■^\/T 


(3-22) 


where 


'A/T 


R  ,  tan  (0  -  0  ) 

A/T  ^  I  A 


(3-23) 


Subs  t  i  Cvit  Ing  oiiuatlon  ('5-23)  Into  eiiuatlon  (3-22)  and  =  0  by 

definition  negligible,  Ra/T  expressed  in  state  variables 


R.  .  =  +2  u)„  R.  . 

A/T  I  A/1 


tan  (0„ 


\  ,  u)2 

A/T  4 


(3-24) 


The  mensurenent  equations  for  al]  of  the  LOS  form  filters 
considered  here  was  given  as 

-l| - ^ - .1  (3-25) 


K  L  =  sin 


!^A/T  -  I'M/T 


The  Proportional  Navigation  Guidance  Law  has  thi;  general  form 


A  =  n  V  u 
CMD  C  MTT.OS 


(3-26) 


where 


Ac.md  =  co:imandod  acceleration  normal  to  LOS 
n  =  gain  constant 

=  i:ii  ss  i  1  e- to- tar(;et  closing  velocity 

ID  =  rate  of  change  of  mi  ssl  J  e-to-target  LOS 

!Tr  LOS 


The  gain  constant  is  a  term  by  which  the  user  can  "tune"  the  guidance 
law  to  optimize  the  overall  performance  of  the  algorithm  for  a  given 
situation.  This  term  typically  has  a  range  of  approximately  3  to  5. 


('sin"  a  lower  nunber  teoils  to  prodiu  o  larger  accelerations  toward  the 
end  of  the  trajectory.  Increasing  the  gain  terra  will  bring  the  missile 
on  course  earlier  in  the  flight  while  the  velocity  is  lower. 


The  closing  velocity  was  derived  from 


-M/T 


r  , 
-M/T 


vc 


I  M/T  I 


(3-27) 


and  expressing  this  in  terms  of  the  state  variables  will  yield; 


Vc 


RM/T  Rm/T  +  2  z 


(3-2S) 


For  the  alr-to-surf ace  scenario  used  here,  it  is  reasonable  to  assume 
that  Rm/t  »  z  and  that  R^/t  Rf^/'f  »  z  z.  With  tlris  assumption, 
the  closing  velocity  can  be  approximated  by  the  missile  velocity  along 
as 


=  «M/T 


(3-29) 


The  expression  for  u>mxloS  becomes  a  little  more  Involved  and 
was  obtained  from 


r  ,  X  vt , 
-M/T  -M/T 


-MThOS 


(3-30) 


-m/t| 

where  a”''  defined  in  equation  (3-5)  and  equation  (3-7). 

As  expressed  In  the  state  variables  this  cross  product  becomes 

2  Z  K^j/'p 


‘^IThOS  = 


'St/I 


“  OJ  - 

i  a2 


'Si/T  '^/T 


^2 


(3-31) 
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In  this  case  the  last  term  Is  ver\'  small  with  respect  to  the  other 
terras  and  Is  neglected.  The  final  expression  for  coraraanded  acceleration 
Is : 


AcMT)  =  -n 


Rm/t 


- Mji  - 

Rm/t 


2  Rm/t 


(3-32) 


3.2.3  Kilter  Model  L.2.  This  filter  model  Is  depicted  by 
Figure  3-2.  The  basic  difference  from  the  L.l  model  is  that  the 
misslle-to-target  1 1  ne-of-sight  (MTl.OS)  frame.  It,  is  used  to  express 
positions  and  velocities.  The  model  Is  developed  in  the  same  manner  as 
tile  L.l  model  and  is,  therefore,  only  summarized  In  terms  of  states, 
state  equations,  measurement  model,  and  guidance  law. 

The  proposed  states  are 


=  Rm/T  “  defined  in  Section  3.2.2  (3-33) 

'^2  -  Rm/T  “  defined  in  Section  3.2.2  (3-34) 

xg  =  X  =  misslle-to-target  llne-of-sight  angle  (3-35) 

X4  =  ujn'LOS  =  ^  J^aCe  of  change  (3-36) 

X5  =  =  as  defined  in  Section  3.2.2  (3-37) 

^^6  “  3S  defined  in  Section  3.2.2  (3-30) 

The  corresponding  state  equations  .are 

:<1  =  x2  (3-39) 

x.,  =  2  X,  X-  X'  +  X,  X?  -1-  w  sin  x_ 

2  4  2  14  3  3 


(3-40) 

-(a^  +  w^)  cos  X.J  +  (a^  !-  w^)  sin  x^ 
xq  =  x4  (3-41) 

2 

-X2 

X4  “  -  (ai  +  wq)  sln(x3)  -  (33  +  w2)  cos  (xq) 

X?  (3-42) 

-  wi  cos  X3 


X5  =>  x6 
xr,  = 
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(3-43) 

(3-44) 


i^ire  T- 


L1  ne-of-r,  Filter  L 

Descript  ion 


3-1  3 


3  Variable 


■-TW’SP 


whe  re 


=  tan(A  -  G>.) 

0!c  =  I'li.fisile  path  aaijle 

and  aT  =  missile  IN'S  total  aci-eleratloiis 
Wj^  =  as  Illustrated  in  Plgtirii  3-3 
Tho  measurement  model  is  yiven  as 


where 


XI  sin  (xs  -  X3) 


(3-45) 


>’a[/o  and  zf-t/o  =  missile  INS  inertial  positions 
^\/o  and  Z;\/o  =  aircraft  inertial  positions 
The  guidance  law  is 

=  fi(xo)(x/, )  (3-46) 

3.3.4  Kalman  Filter.  The  above  state  equations  and  the 
measurement  equation  for  filter  L.l  were  incorporated  into  an  Extended 
ICalman  Filter.  The  standard  Kalman  Filter  could  not  be  >ised  because  of 
the  nonlinear  dynamics.  Tiic  Extended  Kalman  Filter  was  selected  over 
the  linearized  filter  to  deal  with  whole  valued  states  and  to  avoid  ttie 
problem  of  selecting  a  nominal  trajectory  required  for  the  linearized 
filter.  The  filter  equations  are  repeated  here  for  reference. 


The  system  model  is  of  the  form: 

x(t)  =  j:[x(t)  ,  u(t),  t]  +G(t)  w(t) 
z(ti)  =  h[x(ti),  ti]  +  v(ti) 
where 

E[w(t)]  0 

L,f'v(t)  wCt+T)^)^  =  Q(t)  5(t) 
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E(v(ti)]  =  0  (3-47) 

E[v(t{)  _v(t;j)J  =  R(t)  <5(ti  -  i  j) 

The  time  propagation  equations  are: 

:i(t/t^_^)  =  j:(x[tl  ,  Mt]  ,  t)  (3-43) 

ht/t.  ,)  -  E(C)  i'(t/t,  ,)  +  P(t/t.  ,)  fT(l) 

—  i-l  —  —  l-l  —  i.-l  — 

H  G(t)  Q(t)  P"(t)  (3-49) 


where 


F(t) 


31(x[ t] ,  u[t] ,  t) 
_ 


|>.  =  x(ti,/ti-i) 


(3-50) 


rhe  u[i<1ar<'  i  iins  hcin)’. 

i(t.i)  =  P(tD  n"(ti)  [H(ti)  lin)  #(ti)  +  R(ti)]-i 
x(ti)  =  x(tl)  +  K(ti)  £1  -  h(x(ti),  t]  (3-52) 

P(t|)  =r(tr)  -  T(t,)  hdi)  i((tl)  (4-53) 


where 


Il(ti)  = 


]  ,t) 


(3-54) 


Xi  =  Xi(t) 


The  noise  sources,  are  LI  t usi: cateci  in  Figure  3-3  and  are 

additive  Co  the  acceleration  states  as  the.  time  correlated  Gaussian 
noise. 
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The  strtl-.e  equations  expresse<l  in  physical  variables  with  the  noise 
terms  are  summarized  here; 


x(t)  = 


and  if  'oj  is 
needed : 


-2  (i)ji  +  a]  i  in  0]^  f  a3  cos  Oj, 

-  Rm/t  iiV+  2  w?  +  (w.  -  w,  )  sin  +  w  cos 
I  3  1  I  2 

ll,/T 

•  * 

2  7.  W  +  I'  ,  U)--  I-  ZId 

I  n/r  f  i 


+  a^  cos  sin  0^ 


+  zw  +  (w.,  -  cos  0j  +  sin  0j, 


-IDJ 


'^A/T 


2 

Va/T  Q' 


'J/T 


+  \<: 


where  0'  =  tan(0£  -  0,\) 


(3-55) 


A  note  here  that  in  tiie  full  order  filter,  u)^  is  not  a  state  to  be 
estimated  but  a  Piuietion  of  statt.'s  ;  >)  be  estimated.  However,  ttie  W4(t) 
term  was  used  In  ttie  simulation  to  a.i-iply  a  minimal  amount  of  noise  to 
the  z  state  covariance.  This  was  noedeil  to  offset  tlio  negative  trend 
causid  liv  I  he  cri)!;,':  I'oiini  i  nr,  of  other  st.iti'S  into  tlte  state  as  a 
result  of  Killer  Inte.gration  errors-  (Hefecence  Section  5. .2.1). 


For  tile  purposes  of  implementing  I’(to)  the  selection  of  Che 
variances  at  time  t,j  was  based  on  tiic  knowledge  of  the  states  at  the 
time  of  launcli.  At  launch,  the  missile  uncertainties  are  the  same  as 
those  of  the  aircraft.  The  IN.S  on  tin:  aircraft  lias  a  la  uncertainty 


of  2-ft/si2c  In  X  aii'l  z  (Ref.  li)  anj  O.'S  mllli-raiJ  in  attitude.  The 

tracker  used  is  a  Forward  Looking  Tufra-Red  (?LlIi)  class  of  Infra-Red 

(TR)  trackers  with  a  0.3  milli-rad  .ingular  accuracy  and  150  ft  in  range. 

These  figures  yield  lo  values  for  the  following  states. 

r  (0)2  =  Perfect  knowledge  of  z  at  launch  since  missile  is 

on  ATLOS 

7.  (2  I't/scc)^  =  Same  ns  A/C 

^'M/T  (150  ft)^  =  From  the  trackec 

R;]/T  (2  ft/sec)'-  =  Sane  as  A/C 

Oj,  (0.3  MRAD)-^  =  From  tlie  tracker 

cojj  (0.5/sec)^  =  z  er ror/nominal  range  to  TGT  (if  used) 

^A/T  (150  ft) 2  =  From  the  tracker 

^A/T  (2  ft/sec)^  =  From  A/C  INS 

These  values  serve  as  initial  values  for  the  filter  testing. 

The  components  of  the  propagation  and  update  equations  expressed 
and  developed  above  are  summarized  in  Appendix  C  for  reference. 

3.2.5  Observability.  The  seven-state  filter  developed  above 
forms  the  basis  of  a  number  of  reduced  order  filters.  Many  possible 
combinations  of  states  would  appear  to  be  suitable  for  implementation  in 
an  estimator  for  the  missile’s  guid mce.  The  observability  test 
discussed  earlier  in  this  chapter  was  used  to  sort  out  potential 
candidates.  This  test  was  first  performed  on  tiie  full  order  filter  to 
verify  its  validity.  Various  other  combinations  of  states  were  checked 
and  sunmar  iz('d  in  I'.iblo  3-1.  The  and  z  states  were  kept  in  each 
filter  since  the  measurement  model  and  tiie  guidance  law  are  strongly 
influenced  by  them. 

It  appears  from  Table  3-1  that  lo  decouples  the  R;^/t  and 
Ra/T  measurements.  Of  the  combinations  listed  in  this  table,  some 
could  have  increasing  observability  problems  as  o)  goes  to  zero. 
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However,  since  the  observahi Llty  ci'iterLa  was  met  with  one  measurement, 
additional  measurements  were  not  considered. 

3.2.6  Reduced  Order  Filters.  The  state  equations  for  the  reduced 
order  filters  are  essentially  a  subset  of  the  state  equations  developed 
for  the  full  order  filter  and  presented  In  detail  In  Appendix  C.l.  The 
selection  of  state  combinations  was  chosen  to  ensure  observability  as 
determined  in  Table  3-1.  The  Initial  Implementation  will  be  limited  to 
1  as  the  full  order  filter  and  10  as  the  reduced  order  filter. 

Filter  10  was  chosen  since  it  estimates  the  missile  states  which  have 
the  greater  effects  on  measurements  and  the  guidance  law  as  shown  at  the 
bottom  of  Table  3-1. 


TAn?.e  3-1 

hOS  FlhThll  OBSFdlVABIhlTY  SUMHAllY 


States 

Mo.  of 
States 

Observable 

States 

’^(/T  'Vl/T  \  %  \/T  '^A/t! 

..  - 1 

uj  0  u>  =  0 

I'OTh:  fs  ;i  function  of  0^,  "a/Ti  ^.\/T 
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3.3.1  Introduction.  This  sec! Ion  contains  the  development  of 
the  I. I  filter  model  and  tVie  Kalman  Kilter  based  upon  this  model.  The 
1.2  model  follows  the  same  form  of  .Jevelopment  as  the  I.l  model  and  is 
presented  in  summary  form.  In  addition,  a  reduced  order  filter  model  is 
proposed  and  the  corresponding  filtfir  derived.  Observability 
considerations  also  iilay  a  vital  ro  ie  in  determining  the  final 
configuration  of  tliis  reduced  order  model. 

3.3.2  Filter  Model  I.l.  This  filter  model  was  based  on  an 
inertial  frame  focmul.ation  of  relative  ai  rcraf  t-to-target  and 

ni ssile-to-target  information.  Since  both  the  aircraft  and  the  missile 
travel  much  faster  tlian  tlie  target,  the  target  was  assumed  stationary  in 
developing  the  dynamics  erjuatlons.  Also,  the  aircraft  was  assumed  to 
have  a  constant  velocity  and  altltiule  (feasible  due  to  short  missile 
flight  time)  during  the  engagement.  The  dynamics  eC|Viations  are 
developed  based  on  these  assumptlor.s  and  acceleration  uncertainties  are 
modeled  as  white  Gaussian  noises.  The  geometric  relationsliips  are 
depicted  In  Figure  3-4. 

The  states  are 

"  ^TI/T  “  fl  component  of  missile  position  with  respect  to 
the  target 

’^2  "  ^ll/T  -  '1  componcni;  of  missile  velocity  witli  respect  to 
tlte  target 

~  -  i3  component  of  missile  position  with  respect  to 

tlte  target 

X/,  =  ~  i3  component  of  missile  velocity  with  respect  to 

the  target 

X';  •-  =  ii  component  of  aircraft  position  with  respect  to 

the  target 

"  ^A/T  ~  il  component  of  aircraft  velocity  with  respect  to 
the  target 

A 

>'7  =  ZA/T  =  I3  component  of  aircraft  position  with  respect  to 
the  target 

xg  =*  =  i3  component  of  aircraft  position  with  respect  to 

tlie  target 


r 


An  observability  test  w.as  perf-irmed  on  the  1. 1  filter  model  and  the 
results  are  summarized  in  Table  3-2.  Using  the  angle  only  laear urement 
of  elevation  results  in  unobservable  states  in  the  system.  Moreover, 
by  adding  both  mlssile-to-target  range  and  alrcraf t-to-target  range 
measurements,  the  system  still  is  unobservable.  To  obtain  a  more 
observable  system,  the  .aircraft  altitude  z,\/t,  and  Its  rate  of 
change,  za/T»  were  deleted  as  states  from  the  dynamics  model.  The 
aircraft  altitude,  liowcver,  was  na<vii‘d  in  the  measurement  model  and 
guidance  law.  This  information  was  assumed  to  be  passed  from  the 
aircraft  to  the  missile  at  launch  and  extrapolated  hy  the  missile  during 
flight.  As  in  Table  3-3,  only  one  unobservable  state  remains  using  the 
three  measurements.  This  system  wris  implemented  with  the  one 
unobservable  state,  however,  slioived  no  significant  degradation  as  a 
result.  The  ranges  were  passed  from  tlie  aircraft  to  the  missile  at 
launch.  based  upon  tliis  initial  con(!itlon,  tl^e  missile  propagates  the 
ranges,  wltli  uncertainty  accounted  lor,  and  passes  tliem  to  the  filter  as 
psoudo-mensuremonts .  This  initial  investigation  Incorporates  white 
Gaussian  noises  to  model  the  acceletation  uncertainties.  The  addition 
of  time-correlated  uncertainty  models  Is  recommended  for  further  study 
and  comparisons. 

The  state  equations  are 


= 

X2 

(3-56) 

•<2 

= 

ai  +  wi  +  w3 

(3-57) 

^3 

= 

X/4 

(3-58) 

X4 

3 

a  3  +  wo  '^4 

(3-59) 

^5 

= 

(3-60) 

= 

w3  +  W5 

(3-61) 

wbe 

re 

'^l 

.^3 

= 

INS  inertial 

accelerations 

•n 

,W2 

= 

zero  mean  white  Gaussian  noise  models  for  missile 

accei erat ion 

uncer taint les 

4  •> 
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Full  Order  Inertial  Model  Observability 


Measurements 

N’ul.iber  of  Unobservable 
States 

EL 

6 

RL, 

4 

EL, 

4 

EL,  Rm-t,  Rat 

2 

TABLK  3-3 

Sixth  Order  Model  Observability 


Measurements 

Mumber  of  Unobservable 

States 

EL 

4 

EL,  Rat 

3 

EL,  R^^T 

2 

I’.i,,  .Rf,T,  Rat 

1 

W3,w4  = 


zero  inean  white  Gaussian  notse  models  for  inertial  target 
acceleration  uncertalnt les 


zero  mean  white  Gaussian  noise  model  for  Inertial  aircraft 
aci'ol  era  t  ton  oncer  ta  inti  es 


The  statistics  of  the  initial  conditions  and  the  uncertainties  are 
contaimui  in  rioction  3.1.4. 


The  elevation  measurement  equation  was  derived  from  the  geometry 
depicted  in  Figure  3-5. 


-tan  (On  +  Eh)  -  — — 
XM/A 


where 


“M/A  =  15M/T  ~  “A/T 
^M/A  =  >ri/T  -  “A/T 


(3-62) 


(3-63) 

(3-64) 


Taking  tlie  inverse  tangent  of  both  :;ides  of  equation  (3-62)  and  solving 


for  elevation  results  In 


“M/T  -  “A/T 
ilh  =  -Oj  -  tan”'-  - ; - - - 

:<M/T  -  XA/  V 


(3-65) 


-tan  (Oi)  = 


““A/T 

-XA/T 


(3-66) 


Solving  this  equatioti  for  0j^  and  suhst  i  tuClng  into  equation  (3-65) 
yields 

,  -“A/T  ,  “M/T  -  “A/T 

EL  »  tar*^  -  -  tan--  - ; -  (3-67) 

-XA/T  ^1/T  -  XA/T 


In  terms  of  states  tills  becomes 


EL  =  tan“l 

~2a/T 

1 

-  tan~l 

1  ^^3  - 
i  XI. 

ZA/T 

-  X5 

- 

! 

1 _ 

The  aircraf t-to-target  range  Is 


)l/2 

^  A/T  A/T^ 


(3-68) 


(3-69) 


and  in  terms  of  states  becomes 


‘AT 


(x2 


z2,  )l/2 

A/T 


(3-70) 


The  misslle-to-target  range  Is 


VIT 


^Yf/T 


^2  >1/2 

■1/T 


(3-71) 


which  hecoracs 

RmT  =  (xj  +  x2  )U2  (3_72) 

Each  of  the  three  measurements  are  corrupted  by  noise  prior  to  being 
received  by  the  filter.  The  statistics  of  those  noises  and  the  method 
of  processing  the  measurements  are  discussed  in  Section  3.3.4. 

As  discussed  in  the  trutli  model,  proportional  navigation  is  the 
guidance  law  selected  for  this  study.  The  law  can  he  written  as 


A,- 


CMh  ~  •c  <‘>:rr!,os 


The  closing  velocity  Is  determined  by 


r  , 
-n/T 


Vc  =  vj , 

'  /'I 


f^M/T 


(3-26) 


(3-27) 
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The  ro  fort; 


MTLOS 

(x7  +  z2  ) 

M/T  M/T 

In  terms  of  states  this  becomes 

(<2)  (^3)  -  (x!)  (xA) 

tw  “  - 

MThOS 

(x2  +  x2) 

1  3^ 

Thu.s  In  final 

form 

> 

o 

11 

(’'l)(x2)  +  (X3)(x4) 

i(x2)(x3)  -  (xi)(x4) 

1 

(x2  +  x2)l/2 

L  <-<5  *  i) 

(3-79) 


(3-80) 


(3-81) 


3.3.3  Filter  Model  T. .2.  This  filter  niotiel  was  based  on  a 
cartesian  Inertial  coordinate  Cormiijation  of  aircraft  and  target 
variables  and  derived  in  a  similar  -.nanner  as  the  I.l  model  above. 

Filter  1.2  is  summarized  here  in  terms  of  states,  state  equations, 
me.'isurement  model  and  guidance  law.  The  scenario  is  depicted  in 
Figure  3-6.  The  missile  has  accurale  knowledge  of  Its  own  dynamics 
from  the  I'IS  data.  The  filter  estimates  aircraft  and  target  states. 

The  deterministic  dynamics  equation.'  are  based  upon  a  stationary  target 
and  a  constant  velocity,  constant  altitude  aircraft. 

Aircraft  and  target  acceleration  uncertainties  are  modeled  as  time 
correlated  noises.  The  states  are 

Ki  =  xx/o  -  3l  component  of  target  position 

^2  “  ^T/O  “  ^1  component  of  target  velocity 

xq  =  zf/o  =  13  component  of  target  position 
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X4 

=  ax/O  = 

13 

component 

of 

L  II  get  \^eloclty 

=  X4/0  = 

U 

component 

of 

aj  re.raf  t 

position 

Xf, 

■-=  x,\/0  = 

il 

component 

of 

a  i  re  raft 

velocity 

^7 

“  ^A/0  = 

h 

component 

of 

a i  ;  craf  t 

position 

“  2A/0  = 

13 

component 

of 

ai  re raft 

velocity 

T’le  correspon(iin!5  state  equations  ire 


x] 

=  X2 

(3-S2) 

X2. 

=  wi 

(3-83) 

X3 

X/, 

(3-34) 

X4 

=  wq 

(3-35) 

X5 

=-■  x6 

(3-86) 

xr, 

=  W3 

(3-87) 

X7 

’  XR 

(3-88) 

X8 

“  W4 

(3-89) 

where 


wi  and  w2  =  white  Gaussian  nolso  representing  inertial  target 
acceleration  uncer dainties 

wq  and  w/,  =  v/hite  Gaussian  noise  representing  inertial  aircraft 
accelerat Ion  <mcer La Int les 


The  deterministic  measurement  model  Is 


1 

_ 1 

-  tan”*^ 

'^M/o  X7 

XI  -  x5 

x>-l/o  -  ^5 

L  J 

(3-90) 


and  7.'\l o  ~  missile  INS  Inertial  position 
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The  guidance  law  is 

AcmI)  =  n 


<^l/o  ■  ^Vo  -  •'■  ^^M/o  " 


-  ’'•I-''  ^Vo  " 


^i/o  ~  ^"r- 


l/o 


•\3^  ■  ^Vo  "  ^"m/o  " 


'^-Vo  “  "l''  ^  ("h/o  ■ 

■.;ii(?re  the  following  paraiioters  are  .issnriefi  available  from  the  IM.*? 

and  c^I/^,  =  as  defined  abovi, 
xrj/,-,  and  y.',\/o  ~  missile  INS  Ine.-tial  velocities 


(3-91) 


3.3.4  Kalman  Filter.  An  estifnatlon  algorithm  is  next  developed 
based  upon  the  I. I  model  just  described  in  Section  3.3.2.  This  filter 
estimates  the  states  from  noise  coi  upted  observations  of  the  real 
world.  Tlie  optimal  estimation  algo-  Ltlim  for  line.nr  .ystenis  driven  by 
white  Gaussian  noises  is  the  rCalma''  filter.  For  sj’stems  which  are 
iionlincar,  exte.nsiiins  of  the  Kalmar.  ;’ilter  have  been  developed.  A 
partial  list  of  these  extensions  ar.  tlie  linearized  I'.alman  Filter,  the 
Extended  Kalman  Filter,  the  Modifiec  Gaussian  Second-Order  Filter,  and 
the  Truncated  Gaussian  Second-Order  Filter.  The  fir.st  two  of  these 
extensions  linearize  the  system  by  i;slng  the  first  term  of  the  Taylor 
series  expan.slon  about  .a  nonlnal  .st.ite  trajectory.  The  remaining  two 
are  nonlinear  techniques  which  use  •  igher  order  terms  of  the  Taylor 
series  expansion  to  provide  better  iiodellng  of  the  nonl Incar i  t  ies  In  the 
system . 

The  I.l  model  has  linear  dynamics  with  nonlinear  measurement 
equations.  The  linear  dynamics  mod.  i  logically  leads  to  an  equivalent 
discrete-time  model  formulation  and  its  corresponding  time  propagation 
equations.  The  nonlinear  ;iiea.sure.ncai:  oqu.itlons  motivate  the?  use  of  the 
F.xtendcd  Kalman  Filter  (EKF)  equaticus.  The  F.KF  is  the  more  widely  used 
of  the  extensions  to  the  linear  Kal  an  Filter  and  is  a  good  initial 
choice  in  solving  the  nonlinear  estiination  update  problem  because  of 
the  ease  of  implementation. 


f  ( 


k  ! 


Exanples  of  its  use  are  contained  in  references  1,  3,  5,  and  9.  The  EKF 
is  superior  to  the  linearized  Kalmaii  Filter  in  tlmt  it  linearizes  about 
current  estimates  of  the  states,  as  opposed  to  a  reference  trajectory. 
Higher  order  nonlinear  filtering  is  a  more  complex  alternative; 
therefore  is  only  considered  if  the  desired  performance  characteristics 
are  not  met  hy  the  KKF .  The  higher  order  filters  are  also  more 
difficult  and  costly  to  implement  than  tlie  HKF.  ^or  these  reasons,  they 
are  not  considered  in  tills  initial  ;tudy. 


The  filter  dynamics  rooilel  in  m.itrix  form  is 
X  (t)  =  F  X  (t)  +  E  u  (t)  +G..'  (t) 


where 
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1  0  I  0  0 

0  0  0  0  0 

0  1  n  1  0 

0  0  0  n  0 

0  0  1  0  i 


(3-95) 


u(t)  = 


ai(t) 

a3(t) 


E  -32 


(3-92) 


(3-94) 


(3-96) 


1 


Tho  Inirial  coiid  i  t  ion  jc(  t^)  is  Gaussian  with 


K[x(to)]  =  io  (3-0?i) 

i’liCto)  =  lo  (3-09) 

where  the  actual  values  of  _Xq  and  are  contained  in  Appendix  C. 
The  statistics  of  the  dynamic  driving  noise  are 

K[w(t)]  =  0  (3-100) 

G[w(t)  w(t')]  -  Q(t)  6(f  -  t")  (3-101) 


where  Q(t)  is  tlie  strength  of  the  dynamic  driving  noise,  w(t).  The 


noises  are  aasnned  to 

be 

uncorrelated 

which 

leads 

to 

’Qi 

0 
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0  ^ 

0 

Q2 
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0 

0 

Q(t)  = 
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0 

Q3 
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0 

(3-102) 
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v/here  each  strength  corresponds  to  one  of  the  individual  uncertainties 
contained  in  equation  (3-97)  and  depicted  in  Tlgiire  3-7.  As  indicated 
in  the  figure,  all  of  the  uncerta Int ies  are  assumed  to  he  directed  in 
inertial  coordinates.  The  missile  inertial  acceleration  uncertainties 
are  denoted  by  W]^  and  W2 .  The  target  Inertial  acceleration 
uncertainties  are  denoted  by  W3  and  w/, .  Since  the  aircraft  states  in 
the  iq  direction  have  been  deleted  from  the  dynamics  model,  W5  is  the 
only  aircraft  inertial  acceleration  uncertainty  tliat  is  modeled. 


The  equation  used  to  determine  t!ie  strengths  of  the  uncertainties 


is 

Qi  -  —  Oi-  (3-103) 

"'^1 

The  standard  deviations,  ert,  and  correlation  times,  Ti,  are  listed 
in  Table  2-1  and  the  corresponding  strengths  are  contained  in 
Appendix  C. 


Oigital  computer  implementation  motivates  the  equivalent  discrete-time 
model 

x(ti.,i)  =  x(tp  +  5^(r,)  u(t^)  +  w^(t.) 

ivhere 

J^(^d(ci)]  =  ^  (3-105) 


!^-iwd(ti)  wT(tj)]  ■■=  r Qd(ti)  ti  =  tj 

ti  *  tj 

and  the  corresponding  time  propagation  equations 

«‘(tp  - 


r(tp  -  *  Qd<t,_p 


(3-106) 

(3-107) 

(3-108) 


2^(ti)  =  estimate  of  states  just  )>efore  update  time,  ti 

'f(ti,t{-i)  =  discrete-time  state  transition  matrix  to  propagate 
from  time  t^-i  to  ti 

x(ti-i)  =  estimate  of  states  after  update  at  time  ti-i 
^d(ti-l)  “  discrete-time  input  coefficient  matrix 

ii(ti_i)  =  discrete-time  samples  of  the  accelerometer  Inputs 

I^(ti)  =  filter's  conditional  covariance  matrix  just  before 
the  update  time,  tj 


P(tl-l)  =  filter's  condition  covariance  matrix  after  the 
update  at  time  ti-i 

♦T(ti,ti-i)  =  transpose  of  the  discrete-time  state  transition 
“  matrix 

^d(tl-l)  strength  of  the  dynamic  driving  noise,  wd(ti-i), 
at  time  tt-l 

First  order  approximations  are  used  for  the  matrices  ♦  (t-^ ,  tt-l ) , 
Id(tl-l),  tt ,  tt-l)  ,  «nd  Q(}<tl-l)  .  since  the  dynamics 
equation  Is  time-invariant  and  the  sample  period  Is  short  compared  to 
the  system  time  constants.  These  approximations  are 


ld(tt-l^  ■  ^*^1  '^1-1^ 


(3-109) 


(3-110) 


-  Vl'  (3-111) 

With  constant  sampl.e  period,  noise  statistics,  and  dynamics  equation 
coefficients,  these  matrices  are  computed  initially  and  remain  constant 
throughout  a  simulation  run. 

The  actual  matrices  used  for  the  full  order  filter  are  presented  In 
Appendix  C. 

The  measurement  equations  developed  In  Section  3.3.2  are  each 
corrupted  with  a  zero  mean  white  Gaussian  noise,  v(t^),  so  that  the 


form  of  the  measurement  model  Is 


£(ti)  =ji[x(t|),  tj  ]  +_v(ti) 


(3-112) 


where 


X3  -  2A/T 
XI  -  x5 


h[x(tj),ti]  =  (x|  +  ZA/T^)*-^^ 

(x2  +  x2)l/2 


and 


The  statistics 


V2(ti) 

V3(ti) 

of  the  measurement  noise  are 


F,[v(t|)]  =.  n 


Elv(ti) 


where 


R(ti; 

0 


R(tO  = 


Ml  n  O' 

0  R2  0 

0  0  ,  R3 


ti  t^] 

ti  M  / 

'  J 


(3-113) 

(3-114) 


(3-115) 


The  elevation  measurement  noise  strength,  Ri,  was  based  upon  a  standard 
deviation  of  .001  radians.  Squaring  this  value  yields  an  appropriate 
laitlal  choice  for  Ri  of  lO'*’  radians  squared. 

The  pseudo-measurements,  and  RaT>  were  computed  from  filter 
state  estimates  rather  than  truth  model  measurements.  The  general  form 
for  these  measurements  Is 

1  “  (3-116) 

To  generate  a  statistical  description  of  v' ,  let 

h-'(x)  =  li-'(x  +  e)  (3-117) 


where  _e  is  the  filter  errors  and 

+  je)  =  ji'(x)  -f  h'(je)  (3-118) 

tiien  jh^(e)  =  Since  the  measurement,  z' ,  and  the 

filter  estimate  of  the  measurement  were  both  based  on  the  filter  states, 
the  measurement  uncertainty  Is  zero.  The  covariance  of  the  pseudo- 
measurement  then  becomes 


Efv"  v'3'J  *  E[tl  _e  ^  H^J  =  R' 


(3-119) 
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Since  E(£  ^  then 

R'  -  H  P  hT  (3-120) 


which  vs  the  strenj’th  of  the  psotirfo-meiTsurements . 


The  Extended  Kalman  Filter  update  eiiuatlons  are 


!<(t  )  =  P(t:)  HT[t.,^(t:)l  ?(t-)  HT[t  .x(t-)]  +  R(t  ) 

—  i  —  1—  1—  L  —1—1  —  I  —  1—1  i 

(3-121) 


-1 


x(t)  =  x(t7)  K(t  )  C(c.)  -  h(x(t7),  t  ) 
—  i—  1  —  1  -1 - 1  i 


^(t+)  =P(t-)  -  K(t^)  u{t.,x(t;:)]  P(tp 


(3-122) 

(3-123) 


whore 


K(t£)  =  yain  matrix 

R(tt)  =  measurement  noise  strength 


x(t+)  =  state  estimates  after  update  at  time,  t^ 
~  i 

C(Ci)  =  true  measurement  vector  at  time,  ti 


h[x( tj^) , ti ]  =  filter  measurement  calculation  based  on  state 
state  estimates  at  time  t^  before  update 

P(t^)  =  filter's  conditional  covariance  matrix  after  the 
update  at  time,  tj 


and 


r{[ti,x(tr)]  = 


9jl[2L.  tf] 


9x 


X  =  x(ti) 


(3-124) 


The  results  of  the  above  operation  are  listed  in  Appendix  C  for 
reference. 
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Batch  processins  and  recursive  processing  are  two  raethoda  used  for 
incorporating  ineaaureiaents  Into  the  update  equation  at  a  given  sample 
time.  In  hatch  processing,  all  measurements  are  simultaneously 
incorporated  into  ttie  update  equation.  Recursive  processing,  on  the 
other  hand,  accepts  each  measurement  sequentially.  After  the  first 
mpasurei.u!nt  and  the  corresponding  update,  the  new  state  estimates  and 
covariances  are  a|iplle<l  wit!i  no  propagation  stage  In  the  update  equation 
when  the  next  measuremont  is  processed.  In  this  study,  recursive 
processing  of  the  measurements  is  vised  for  the  inertial  Extended  Kalman 
Filters . 

The  recursive  form  has  qualities  that  make  It  preferable  to  batch 
for  on-line  processing.  In  an  online  situation,  ti»e  computer  allov;s 
only  a  finite  amount  of  time  for  state  estimation.  It  is  possible  to 
get  cut  off  in  the  middle  of  incorporating  the  measurements  and, 
therefore,  lose  all  of  the  update.  In  recursive  processing,  however,  at 
least  some  of  tl\e  measurements  could  have  been  incorporated  and  the 
inherent  benefits  realized.  Recursive  processing  also  uses  smaller 
matrices  than  batch  and  thus  has  simpler  algorithms  to  compute. 

For  the  Extended  Kalman  Filter,  recursive  processing  has  the 
potential  for  yielding  better  estimation  performance,  than  batch 
processing.  The  Extended  Kalman  Filter  state  estimates  and  covariances 
are  iteratively  computed  based  upon  a  relinearization  about  the  state 
estimates  each  time  they  are  computed.  Batcli  processing  the 
measurements,  in  this  case,  results  in  a  single  computation  of  the 
nominal  trajectory  at  eacli  update.  The  recursive  method,  however, 
computes  more  than  one  nominal  at  eac.h  up  ate  time,  with  each 
successive  computation  being  a  better  approximation  than  the  previous 
one.  The  recursive  method  thus  has  tite  potential  for  yielding  better 
re.sults,  especially  vdien  the  most  accurate  measurements  are  processed 
first. 
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3.3.5  Filter  MoJcl  1.3.  Full-order  filters  are  rarely 
Incorporated  as  on-line  estimators.  These  filters  are  to  be  used  as 
benchmarks  for  comparison  of  reduced  order  filters.  However,  full- 
order  filter  models  are  often  Inappropriate  as  benchmarks  because  of 
observability  problems.  For  this  reason,  the  full-order,  eight  state 
model  in  this  study  was  reduced  to  six  states.  In  addition,  full-order 
filters  are  a  computational  burden. 

This  section  contains  a  reduced  order  filter  model  which  Is  simply 
the  I.l  filter  model  with  the  remaining  aircraft  states  deleted.  Since 
the  missile  Is  much  mori;  dynamic  than  either  the  aircraft  or  the  target, 
accounting  for  missile  acceleration  uncertainties  and  estimating 
relative  missile-to-target  states  is  preferable.  Therefore  for  this 
reduced  order  model,  the  relative  aircraf t-to-target  states,  X5  and 
xr,,  are  deleted  from  tiie  I.l  dynamics  model.  Since  relative 
aircraf t-to-target  position  and  velocity  are  needed  In  the  measurement 
model  and  the  guidance  law,  tliey  are  assumed  to  be  passed  to  the  missile 
at  launch  and  then  extrapolated  by  the  missile  during  flight.  For  the 
filter  update,  however,  t!je  filter’s  prediction  of  what  the  measurement 
will  be  Includes  these  crude  computations  of  relative  aircraf t-to-target 
positions.  All  errors  between  the  actual  measurements  and  the  filter's 
prediction  of  the  measurement  are  processed  by  the  filter,  however, 
these  errors  are  also  the  result  of  unmodeled  noises  and  errors  in 
propagated  parameters.  This  factor  must  be  considered  during  the 
performance  analysis  of  the  filter. 

The  proposed  states  are  the  same  as  used  in  the  1.1  filter  model, 
but  with  a  reduction  In  order.  The  corresponding  matrices,  initial 
condition  statistics,  and  noise  statistics  are  contained  in  Appendix  C. 
The  states,  state  equations,  measurement  model,  and  guidance  law  are 
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repeated  (with  appropriate  modlf ic.atloas)  for  convenience  to  the 
reader.  The  states  are 


’'l 

=  component 

of 

relative 

misslle-to-target  position 

^2 

=  .  =  1  component 

M/T  1 

of 

relative 

missile-to-target  velocity 

=  z  ,  =  compo'’  ■^nt 

M/T  3 

of 

relative 

missile-to-target  position 

.  ? 

=  z  ,  =  L,  compone  .r 

M/T  3 

of 

relative 

mlssile-to-target  velocity 

and  ttie 

state  equations  are 

XI 

=  X2 

(3-125) 

X2 

=  ai  +  wi  -1-  w3 

(3-126) 

X3 

™  X4 

(3-127) 

X4 

“  a3  +  W2  +  w4 

(3-128) 

Observability  analysis  of  this  model  (Table  3-4)  reveals  that  in  order 
to  have  complete  observability,  a  mlssile-to-target  range  measurement 
is  necessary  in  addition  to  the  elevation  measurement. 


TABLE  3-4 

Fourth  Order  Model  Observability 


— 

Measurements 

Number  of  Unobservable 

States 

EL 

2 

El,,  R,,t 

0 
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The  elevation  measurement  equation  is 


EL  =  tan 


-1 


=A/T 


-xa/T 


tan~^ 


The  range  measurement  equation  is 

%/T  =  (:<?  + 


X3  -  ZA/T 
XI  -  XA/T 


(3-129) 


(3-130) 


The  guidance  law  is 


A 

CMD 


(xi)  (ko)  +  (x3)  (X4) 

(x2  -t  x2)l/2 


3. A  Summary 


(x2)  (x3)  -  (xi  (x4) 


Cx|  x2) 


(3-131) 


The  various  filters  that  were  considered  for  implementation  wore 
specified  in  this  chapter.  The  filter  development  approach  starts  out 
with  defining  models  upon  whldi  to  base  the  filters.  A  model  selection 
process  Chen  takes  place  in  which  models  were  chosen  for  implementation 
based  upon  their  favorable  ch.aracteristics .  Two  basic  model 
formulations,  LOS  and  inertial,  are  selected  for  further  development 
and  analysis.  A  reduced  order  model  from  each  of  these  basic 
formulations  was  chosen  principally  by  deleting  states  Chat  have  the 
least  effect  on  the  filter  measurement  prediction  and  the  guidance  law 
commands.  Observability  also  played  a  key  role  in  determining  the  final 
form  of  these  models.  State  estimation  algorithms  were  then  proposed 
for  each  model  based  upon  the  dynamics  equation  and  measurement  model. 
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IV.  SOFTWARE  DEVELOPMENT  AND  VALIDATION 


4.1  Int  r oduc  t Ion 


A  Software  simulation  viras  produced  In  conjunction  with  the 
developments  in  Chapter  II  and  III  to  provide  the  means  to  evaluate  the 
filters,  guidance  law,  and  dynamics  models  associated  with  the  UVM 
scenario.  The  software  for  this  simulation  was  developed  in  three 
phases:  Truth  Model  Validation,  Filter  Validation,  and  Monte  Carlo 
Incorporation. 

4.2  Truth  Model  Implementation  and  Validation. 


The  overall  flow  of  the  program  executive  (Fig.  4-1),  briefly 
described  below,  was  developed  based  on  the  scenario  diagram  (Fig.  2-2) 
to  control  the  timing  and  sequence  of  the  simulation  events.  Some  of 
the  features  and  implementation  metliods  are  discussed  here.  All 
repetitive  functions  or  events  such  as  coordinate  transforms , truth 
models,  and  filters,  were  committed  to  subroutines.  The  aircraft, 
missile,  and  target  dynamics  truth  models  were  implemented  as  first 
order  vector  differential  equations.  Initially  a  predictor-corrector 
variable  step  size  Integration  routine  was  used  to  propagate  the  states. 
For  computational  efficiency,  the  aircraft  and  target  models  were 
changed  to  Euler  integration  since  tlie  time  constants  associated  with 
these  two  models  are  2  seconds  and  .5  seconds,  respectively,  as  compared 
to  the  .02  second  sample  period.  This  change  reduced  the  run  times  by 
about  40  percent. 

Dynamic  driving  noise  was  added  to  the  three  truth  models  and  to 
the  INS  measurements.  The  INS  noises  were  added  as  random  bias  since 
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Figure  4-1  Single  Mission  Simulation  Flow  Diagram 
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the  random  walk  phenomenon  In  the  INS  typically  has  correlation  times 
greater  tlian  IS  minutes  while  the  missile  has  a  flight  time  of  less  than 

4  seconds.  The  dynamics  truth  model  driving  noise  was  added  as  time 
correlated  noise  at  the  acceleration  level.  The  simulated  measurements 
taken  from  the  truth  models  are  also  corrupted  by  additive  noise.  The 
initial  test  case  filter  is  a  "true  state"  filter  whose  states  are 
computed  based  upon  the  truth  model  rather  than  on  an  estimation 
process.  The  values  were  used  by  the  guidance  law  to  compute  the 
desired  accelerations  whlcli  In  turn  were  passed  to  a  discrete  time 
second  order  lag  (Appendix  B.l).  This  lag  models  the  delays  In  actuator 
response  and  missile  attitude  response  and  outputs  the  missile's  total 
acceleration. 

The  initial  test  cases  for  the  truth  models  are  Illustrated  in 
Fig.  4-2.  These  profiles  exercised  the  lateral  and  vertical  dynamics 
and  the  guidance  law  to  check  for  major  implementation  errors.  To 
further  check  the  algorithms  the  commanded  acceleration  was  fixed  at 
100  ft/sec/sec  and  propagated  for  .1  seconds.  The  change  in  position 
and  velocity  compared  with  the  closed  form  approximations  with  less  than 

5  percent  error.  Therefore,  the  truth  model  represented  well  the 
Intended  trajectory. 

4.3  Filter  Implementation  and  Validation. 

Valid  truth  models  gave  the  needed  foundation  for  implementing  the 
filters  developed  in  Chapter  III.  The  "true  state"  filter  was  replaced 
by  the  filters  designed  and  the  dynamics  restricted  to  the  vertical 
plane.  In  validating  the  filter  for  a  given  flight  profile,  the  filter 
was  critiqued  in  two  main  areas.  First  was  whether  or  not  the  dynamics 
of  the  states  responded  according  to  the  commanded  accelerations  as  did 
the  truth  model.  And  secondly,  did  the  covariance  matrix  remain 
positive  semldeflnite.  This  testing  was  accomplished  without  driving 
noise  added  to  the  truth  model  states  and  without  perturbed  initial 
conditions.  As  discussed  in  tlie  filter  evaluation  (Section  5.2.1), 
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using  Euler  Integration  to  propagate  ^(t)  and  the  filter  states  produced 
numerical  errors  that  seriously  degraded  the  filter  performance.  The  JP 
matrix  had  diagonal  elements  that  were  becoming  negative.  The  solution 
found  was  to  add  noise  via  the  ^  matrix  to  offset  the  Integration 
errors.  Some  of  the  filter  states  were  accumulating  a  growing  bias  due 
to  the  errors  in  Euler  integration  and  the  large  dynamics  Input  to  the 
filter.  These  errors  were  reduced  by  as  much  as  50  percent  by 
incorporating  a  trapezoidal  integration  Into  the  state  propagation 
portion  of  the  filter. 

4.4  Monte  Carlo  Incorporation. 

Two  changes  were  needed  to  convert  this  simulation  into  a  full 
Monte  Carlo  program.  The  first  was  to  add  a  case  controller  and  second 
was  to  add  an  Interface  tape  (Ref.  12)  tu  take  advantage  of  an  existing 
Monte  Carlo  evaluation  and  plotting  package  (Ref.  3).  The  short  case 
controller  routine  became  the  executive  and  calls  the  program  developed 
above  as  a  subroutine  the  specified  number  of  times.  Each  call 
generates  a  full  time  history  of  the  true  missile  states,  filter  state 
estimates,  and  filter  covariance  estimates  based  upon  the  same  set  of 
true  Initialization  parameters  but  with  different  initial  condition 
error,  state  dynamic  noise,  and  measurement  noise  realizations  In  each 
case.  The  second  change  provides  a  composite  output  of  a  header  and  all 
case  time  histories  in  a  format  acceptable  by  the  Honte  Carlo  evaluation 
routine  developed  at  AFWAL.  This  post  processor  routine  provides  plots 
of  designated  parameters  based  upon  the  case  time  histories.  These 
parameters  Include  ensemble  averages  of  filters  and  truth  model  states, 
means,  and  covariances. 


V.  ANALYSIS 


5.1  Introduction. 

The  analysis  of  the  filters  covers  two  broad  areas:  Issues  of  note 
that  surfaced  during  filter  development  and  filter  performance.  The 
filter  development  Includes  work  done  to  produce  working  filters. 

Filter  performance  Is  demonstrated  by  probability  of  kill  and  computer 
loading  comparisons.  Another  aspect  of  the  performance  considered  Is 
how  well  does  the  filter  work  with  the  guidance  law.  The  LOS  filter 
performance  plots  are  Figures  F-1  through  F-32  in  Appendix  F  and  the 
Inertial  filter  performance  plots  are  Figures  F-33  through  F-62. 

5.2  Filter  Development  and  iCvaluatlon 


5.2.1  LOS  Filter.  The  initial  trial  runs  on  filter  LOS.l  revealed 
a  problem  In  the  propagation  and  update  of  the  _P  matrix.  Since 
negative  values  v/ere  appearing  on  ttie  diagonal,  the  covariance  matrix 
was  losing  It's  positive  semi-def Ini te  nature.  The  following  steps 
were  taken  to  Isolate  the  cause  of  the  problem. 

The  negative  values  appeared  on  the  diagonal  shortly  after  the 

first  update.  So  the  first  step  was  to  rule  out  the  possibility  of 

numerical  precision  problems  because  of  tbe  large  condition  number, 

13 

10  ,  of  tbe  Initial  _P  matrix  and  _K  value.  Tbe  Joseph  form  of  update 
has  been  shown  to  be  less  troubled  by  this  (Ref.  10).  However,  there 
was  no  improvement  or  even  change  when  this  form  of  update  was  used 
indicating  that  the  condition  number  was  not  the  problem  in  the  update. 


The  next  step  was  to  obtain  the  eigenvalues  and  eigenvectors  of 
the  covariance  matrix  to  Isolate  when  and  where  the  problems  began.  An 
available  routine  using  the  QR  algorithm  was  used  to  compute  these 
quantities.  By  the  third  tine  propagation,  one  of  the  eigenvalues  of 
the  covariance  matrix  was  going  very  slightly  negative  (-0.00019).  At 
this  point,  the  most  likely  explanations  were  either  the  Euler 
integration  step  size  was  too  large  with  respect  to  the  JP  matrix  time 
constants  or  the  large  range  of  covariance  matrix  eigenvalues  was 
inducing  computational  errors. 

In  pursuing  the  first  possibility,  the  integration  step  size  was 
reduced  by  a  factor  of  100,  from  0.02  seconds  to  0.0002  seconds.  This 
produced  a  dramatic  change  for  the  better  in  the  positive  semi-definite 
nature  of  the  covariance  matrix  but  the  very  small  negative  eigenvalue 
nature  persisted.  The  next  improvement  in  the  integration  accuracy  is 
to  use  a  variable  step  size  predictor-corrector  type  of  integration. 
This  integrator  reduced  the  negative  trend  on  the  one  diagonal  element 
of  the  covariance  matrix  to  almost  0.  However,  it  is  not  practical 
to  implement  this  type  of  algorithm  in  a  missile  computer.  Also 
altering  the  matrix  was  attempted  but  only  changed  the  time  at  which 
the  diagonal  elements  went  negative. 

The  four  state  filter  (Filter  1.3)  also  exhibited  the  same 
characteristics.  Since  four  state  filter  is  mathematically  simpler  to 
deal  with,  it  was  used  to  pursue  other  potential  explanations. 

To  obtain  the  time  constants  of  the  ^(t)  equation  It  is  necessary 
to  formulate  the  expression,  the  homogenous  form,  with 

G  Q  gT  term  ignored  at  present.  The  ^  matrix  used  was  taken  from  the 
propagation  at  T=  0.02  and  the  ^  matrix  indexed  to  correspond  to  the 
elements  in  equation  (5-4). 
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Since  F  P  +  P  Is  symmetric,  there  are  only  10  unique  elemeiits-  Thus 
equation  (S-S)  can  be  reconstructed  to  form  a  linear  first  order  vector 
differential  equation  for  these  ten  elements. 


where 


2  2d  -  -  -  -  - 

-  -  c  1  d  -  - 

-  -  1-1-8 
ab---l- 

-  2c  - 

-  -  -  a  b  -  - 


a  -  b  - 

2a  -  2b 
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and  a  =  -.0952 
b  =  .00227 

c  =  .0952 


A  =  -.0476 


-  =  0.0 


The  eigenvalues  of  the  matrix  characterize  the  JP  matrix  dynamics. 

For  this  case,  4  eigenvalues  were  0.0,  2  pair  at  0.0  ±  0.0033j,  and 
one  pair  at  0.0  ±  0.0066j.  All  the  non-zero  coots  are  Imaginary  and  of 
a  very  low  frequency.  Since  Che  integrator  step  size  Is  much  less  Chan 
the  period  of  the  low  frequency  com.nonents,  the  hypothesis  of  under 
sampling  can  he  dismissed  as  the  cause  of  the  negative  trend  in  the 
e Igenvalues . 

The  other  potential  cause  is  the  large  difference  in  eigenvalues, 
in  the  covariance  matrix.  The  solution  was  to  scale  the  covariance 
matrix  using  a  similarity  transform  to  yield  a_P(t)  with  a  good 
condition  number.  (Refs.  10  and  14)  This  basically  states  Chat  for  a 
given  matrix  there  exists  a  matrix  that  can  transform  the  state  space 
to  a  new  basis  and  tTiereby  scale  It.  The  transform  matrix  chosen  was 
based  upon  tho_P(to).  The  expressions  used  to  change  the  basis  of  the 


state  .space  are  sunitiar Ized  In  Appendix  E.l  This  transforra  produced  a 
P^(t),  with  a  low  condition  nviraber,  that  was  propagated  and  then  returned 
to  the  orlglonal  state  basis  with  virtually  Identical  results.  The 
expressions  used  to  change  the  basis  of  the  state  space  are  summarized 
in  Appendix  E.l. 

Up  to  this  point,  the  problem  in  the  full  order  filter  has 
persisted  through  varying  the  integration  step  size,  two  integration 
methods,  and  a  scaling  of  the  covariance  matrix.  The  problem  in  the 
reduced  order  filter  has  also  persisted  through  varying  the  integration 
step  size  and  setting  the  Q  matrix  to  zero  to  see  how  the  ^  matrix  was 
propagating . 

The  J^^Ctg)  matrix  when  combined  with  the  state  equation 
formulations  as  expressed  in  the  F  matrix,  could  be  ill  conditioned. 

This  could  be  shown  by  one  P  matrix  element  propagating  negative  values 
into  the  diagonal  elements.  To  verify  this,  both  the  JQ  matrix  and  the 
l^(to)  matrix  are  set  to  zero  and  only  one  of  the  J^(to)  diagonal 
terms  was  set  to  previously  computed  values  per  run.  After  propagating 
the  _r  matrix,  the  element  was  increased  by  a  small  delta  while 
another  diagonal  element  was  decreased  by  the  same  amount.  The  only 
exception  was  the  term  which  remained  constant  and  did  n(|t  couple 
Into  the  other  elements.  As  Pii(t)  remained  constant  on  its  own  and 
it's  associated  ^  ^  element  is  0,  it  tended  to  accumulate  the  small 
negative  coupling.  The  Ruler  Integration  method  was  found  to  produce 
the  negative  trend  (see  Appendix  F..2).  The  integration  perfornied 
analytically  in  closed  form,  however,  docs  not  exhibit  this  problem. 

The  solution  then,  was  to  bias  the  P]^]^  term  artificially  to 
counter  the  negative  trend  caused  by  this  numerical  method.  In  the 
simulation  this  bias  was  added  through  the  ^  ^  expression.  A  bias 
value  of  .3  to  .5  added  to  the  P]^i  element  was  found  to  be  sufficient 
for  this  formul.'ition.  The  large  time  varying  acceleration  (thrust  and 
commanded  acceleration)  acting  on  the  missile  also  produced  large 
errors  in  the  states  when  using  Euler  integration.  This  effect  can  be 
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seea  by  the  error  trend  in  Figures  F-1  and  F-2  which  were  produced  with 
Euler  integration  and  no  driving  noise  in  the  truth  model.  The  second 
order  effects  were  then  included  in  the  integration,  now  a  trapezoidal 
integration,  to  reduce  the  errors  in  propagating  Che  states.  This 
improvement  in  accuracy  is  illustrated  in  comparing  Figures  F-3  and  F-4 
with  Figures  F-1  and  F-2,  respectively.  Additional  measurements  were 
not  considereil  since  the  observability  criteria  was  met  without  tiiem. 

5.2.2  Inertial  Filter.  The  inertial  filter  development  did  not 
exhibit  difficulties  In  the  filter  covariance  as  did  the  LOS  filter. 
c5\it  a  need  for  additional  measurement  information  existed  to  meet 
the  observability  criteria.  The  more  dramatic  effects  of 
incorporating  the  two  pseudo-measurements  (Section  3.3)  are  Illustrated 
in  Figures  F-33  and  F-34  in  the  reduction  of  the  covariance  of  the 

X  position  of  Che  aircraft.  Also,  there  was  a  need  for  Improved 
integration  in  the  state  propagation  as  in  the  LOS  filter.  The 
trapezoidal  Integration  was  implemented  but  did  not  operate  properly. 
This  was  a  function  of  the  coding  ratlier  than  the  algorithm,  as  verified 
by  decreasing  Che  Euler  integration  step  size  by  a  factor  of  10,  from 
.02  seconds  to  .002  seconds.  This  approach  should  approximate  the 
trapezoidal  integration  results  at  a  .02  second  step  size,  for  purposes 
of  comparing  the  performance  of  the  Inertial  filter  to  that  of  the  LOS 
filter.  This  improvement  is  Illustrated  by  comparing  Figures  F-37  'nd 
F-38  with  F-35  and  F-36  respectively. 

5.2.3  Tuning.  The  initial  simulation  runs  were  made  with  the 
computed  values  of  JP(tf,)  and  Q  as  presented  in  Table  2-1  and  with  no 
perturbations  in  the  initial  conditions.  When  the  filter  is  properly 
tuned,  the  mean  and  the  standard  deviation  of  the  errors  will  remain 
within  the  bounds  set  by  the  square  root  of  the  diagonals  of  the 
covariance.  If  this  is  not  the  case,  then  the  magnitudes  of  the  ^ 
element  can  be  increased  to  realize  the  above  criteria.  As  a  starting 
point,  the  Q  values  are  based  upon  P(to)  and  the  values  of  Q  used  In 
the  truth  model  for  the  dynamic  driving  noise.  (Ref.  Section  2.5)  Error 


statistics  were  taken  from  samples  over  5  runs  during  the  tuning 
process  for  the  and  0j,  states.  The  5  runs  would  be 
sufficient  to  identify  major  difficulties.  The  Initial  ^  values 
selected  for  the  LOS  filter  allowed  the  standard  deviation  of  the  error 
to  grow  outside  the  standard  deviations  expected  by  the  filter  (Fig. 

F-5  and  F-6).  This  was  corrected  by  increasing  the  values  of  Q  matrix 
which  would  Increase  _P(t)  and  increase  the  relative  weighting  on  the 
measurements  In  the  state  update. 

the  LOS  filter,  the  ^  associated  with  Rjj/'p  was  increased  by 
a  factor  of  10  to  1450  ft2  and  the  Q  for  Ojj,  was  set  to  0.01  rad^. 

These  values  brought  the  standard  deviation  of  each  state  to  within  the 
bounds  set  by  T,/Pj^|( t )  of  the  filter.  See  Figures  F-7  and  F-8  for  the 
LOS  filter  and  Figures  F-41  and  F-42  for  the  inertial  filter. 

The  dynamic  driving  noise  was  set  to  zero  and  bias  noise  terras 
were  added  to  the  initial  conditions  to  evaluate  the  response  of  the 
filter  to  initial  transients  caused  by  errors  in  initial  state 
estimates  (Figures  F-9  and  F-10  and  F-43  and  F-44) .  Each  initial 
condition  error  realization  was  computed  by  6  ^{(to)  =  S^P(to)  w 
where  jw  £  N((l  ,1^) .  The  bias  was  added  to  the  associated  filter  state  at 
tg.  This  check  should  reveal  any  divergent  tendencies  in  the  filter 
s  Cates . 


The  perturbed  Initial  conditions  and  the  propagation  noise  in  the 
filter  were  both  considered  in  the  remainder  of  the  performance 
evaluation  of  the  filter.  Also  the  number  of  runs  per  case  Is  increased 
to  20  runs  to  provide  larger  sample  si)ace  for  the  statistical  analysis. 
Ref.  Figures  F-11  and  F-12  ami  F-45  and  F-A6.  During  Che  analysis  of 
the  data  plots  In  Appendix  F  it  was  necessary  to  exclude  the  radical 
transients  after  approximately  2.85  sec.  Since  all  of  the  runs  in  a 
given  Monte  Carlo  run  v/lll  not  complete  at  the  same  time,  it  was 
necessary  to  extend  to  final  time  to  Insure  all  the  runs  for  the  given 
case  were  completed. 
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The  data  plotted  after  the  Iiiipact  time  then  Is  of  no  value.  As  a  final 
result  the  Q  diagonal  terms  found  for  the  LOS  filter  are: 

3000  for  Target  k  acceleration 
1450  for  Missile  x  acceleration 

1450  for  Missile  z  acceleration 

5  for  Missile  z  position 

100  for  A/C  LOS  acceleration 

.01  for  LOS  0 

and  for  the  Inertial  filter: 

3000  for  Target  x  acceleration 

1000  for  Missile  x  acceleration 

1000  for  Missile  z  acceleration 

400  for  A/C  X  acceleration 

These  values  were  derived  only  for  a  launch  at  2000  ft  altitude  and 
10,000  ft  range.  For  other  launch  scenarios,  additional  study  would  be 
required  to  confirm  Che  validity  of  these  filter  parameters. 

5.2.4  Measurement  Residual.  The  LOS  filter  exhibits  a  large 
measurement  residual  on  the  first  few  updates,  on  tlie  order  of 
.03  radians.  This  behavior  is  Illustrated  in  Figure  F-27  with  no 
driving  noise  in  tlie  truth  model  and  in  Figure  F-28  with  driving  noise 
and  perturbed  initial  conditions.  The  magnitude  of  the  residual  should 
be  less  than  1  mi  I  li-radian .  This  error  is  a  result  of  sm^ill 
perturb.atlons  in  t)ie  z  state  wlien  the  a  I  rcra  f  t-to-miss  1  le  range  is  small 
that  has  a  significant  effect  on  Filters  estimate  of  the  measurement  at 
the  first  update.  The  most  likely  solution  is  to  Ignore  the  first 
measurement.  This  would  be  the  case  in  a  real  world  situation,  since 
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the  missile  may  not  be  within  view  of  the  laser  grid  scan  until  the 
second  or  third  update.  The  problem,  however,  does  warrant  further 
investigation. 

The  inertial  filter  did  not  produce  this  large  residual  In 
the  elevation  measurement,  see  Figures  F-57  and  F-58.  The  orientation 
of  the  filter  reference  frame  was  not  aligned  with  the  reference  frame 
of  the  measurement,  thus  small  errors  in  the  states  will  effect  both 
the  range  along  the  misslle-to-targct  LOS  and  the  distance  of  the 
missile  off  tlie  LOS.  This  orientation  would  tend  to  reduce  the  overall 
effects  of  the  errors  in  the  states  on  the  measurement  residual. 

5.3  Filter  Performance 

5.3.1  Reduced  Order  Filter  Performance.  The  reduced  order 
filters  performed  similarly  to  the  full  order  filters,  see  Figures  F-19 
through  F-2?,  and  F-45  through  F-48,  as  compared  to  Figures  F-29  through 
F-32  and  F-59  through  F-62,  respectively.  In  some  states  the 
performance  was  better  as  la  Figure  F-30  with  respect  to  Figure  F~20. 
This  Improvement  was  expected  since  the  parameters  excluded  from  being 
states  had  a  negligible  effect  on  the  navigation  solution.  Also  there 
was  improved  observability  as  a  result  of  removing  some  of  the  states 
that  have  like  orientation  and  dynamics  as  other  states.  This  improves 
the  benefit  of  the  measurement.  The  behavior  of  the  covariance  of  the 
^'A/T  does  not  agree  with  the  behavior  of  the  standard  deviation  of 

the  errors  in  Figure  F-55.  The  probable  cause  of  this  is  cross  coupling 
effects  in  the  filter  states  and  warrants  further  study. 

5.3.2  Probaht  11 ty  of  Kill.  At  this  point  it  is  of  value  to 
consider  a  figure  of  merit  related  to  the  probability  of  kill  for  a 
missile  equipped,  in  turn,  with  each  of  the  filters  in  this  study. 

The  mean  and  standard  deviations  are  computed  from  the  Monte  Carlo  run 


miss  distances  of  each  flight  for  each  case.  These  two  values  then 
will  characterize  the  Gaussian  distribution  of  the  hit  area.  Also 
consider  that  the  target  vulnerability  area  can  be  modeled  by  a 
probability  of  kill  function  which  Is  a  Gausslan-shaped  distribution, 
fxCx) >  with  zero  mean  and  standard  deviation  relative  to  the  size  of 
the  target.  The  area  under  this  curve  is  scaled  to  be  directly 
proportional  to  a  rectangular  shaped  function  with  magnitude  of  1.0, 
with  a  width  relative  to  the  size  of  the  target,  and  centered  on  the 
target.  For  this  example  let  ot  =  D/2  where  D  Is  the  diameter  of  Che 
target  vulnerable  area.  The  scale  factor  on  Che  Gaussian  curve  Is 
chosen  such  that 

11m  ffCx)  =  1  (5-6) 

>  00 


This  occurs  only  if  the  scale  factor  Is  2it  07  as  seen  in 

equation  (5-7)  for  the  target.  The  probability  of  damage  Is  then  the 

marginal  probability  of  the  target  distribution  function  and  the  missile 


hit  area  v/hiclj  can  he  expressed  as 


f(x) 


a  e-d^/s^ 

lit  s 


(5-7) 


where  for  the  missile  hit  probability  density 
a  “  1 


s  o^t 
d  =  X  -  ^ 

^  =  mean  of  the  miss  distance 
and  for  the  target  vulnerable  area 


a  =  2ir  Of 
s  =  Of 


d  =  X 
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Integrating  over  all  x,  the  marginal  probability  will  yield 


PK  = 


+  Of^) 


(5-8) 


TABLE  5-1 

MISSILE  ACCURACY  AS  A  FUNCTION  OF  THE  FILTER  TYPE 


Filter 

States 

Mi  ss 

Mean 

Distance* 

Std.  Dev. 

PK(aT  =•  5.0) 

LOS.l 

7 

.62 

3.02 

.89 

LOS.  2 

4 

.06 

3.48 

.82 

INERT. 1 

6 

-1.0« 

5.00 

.69 

INERT. 2 

4 

-l.ll 

5.05 

CO 

*  Miss  distance  based  upon  minimum  missile-to-target  range 
with  the  launch  from  10,000  ft  rangn  and  2000  ft  altitude. 


The  LOS  filter  produced  a  probability  of  kill  approximately  20% 
better  than  the  Inertial  filter.  This  is  due  to  the  larger  means  and 
st'ndard  deviations  of  the  niss  distance  for  the  given  scenario.  Also 
note  that  the  reduced  order  filter  performed  within  4%  of  the  larger 
counterparts . 


5.3.3  Computer  Loading.  Also  of  concern  is  whettier  or  not  the 
desired  filter  can  be  implemented  in  an  onboard  computer.  One  aspect  of 
implementation  is  the  computer  work  load  requirements  in  terms  of 
operations  per  second  for  a  given  filter,  integration  interval  size  and 
update  rate.  For  the  filters  developed  in  this  study,  an  algorithm  was 
derived  for  the  LOS  filter  and  one  for  the  Inertial  filter  to  give  an 
estimate  of  the  number  of  operations  performed  per  time  propagations  and 
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per  update  as  a  function  of  the  number  of  filter  states.  The 
operations  were  characterized  into  three  groups:  adds  and  subtracts, 
multiplies  and  divides,  and  square  roots  and  trigonometric  functions. 
This  grouping  permits  better  estimation  of  the  timing  requirements 
needed  for  the  chosen  filter  to  run  real  time.  The  number  of 
operations  per  filter  for  time  propagations  and  updates  are  given  as: 


TARLK  5-2 

OPERATIONS  REQUIRED  FOP.  ONE  TIME  PROPAGATION  AND 
ONE  UPDATE 


LOS  FILTER 

Time 

Propagations 

Updates 

Adds: 

2n3 

+  n2  +  38 

n3  +3n2  +  2n  +  m/2 

Multiplies : 

2n3 

+An2  +  39 

2n3  +  2n2  +  2n  +  m 

Square  Roots: 

a  4* 

5 

1 

INERTIAL  FILTER 

Time 

Propagations 

Updates 

Adds : 

6n  + 

m 

n3  +  3n2  +  2n  +  m  +  2R  -  2 

Multiplies : 

5n  - 

2 

2n3  +  2n2  +2n  +  2ra  +  3R  -  3 

Square  Roots: 

0 

m/2  +  R 

where  n  =  number  of  filter  states 

m  =  total  number  of  parameters  propagated  (8  in  this  study) 
R  =  number  of  measurements  required  per  update 

1  for  the  LOS  filters 

3  for  the  Inert. 1  filter 

2  for  Inert. 2  and  Inert. 3  filters 
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Summarizing  Che  above  expressions  will  yield  the  following  Cable 


TABLE  5-3 

NUMBER  OF  OPERATIONS  PERFORMED  BY  FILTERS 


FILTER  OPERATIONS  PER 


FILTER 

Time  Propagation 

Update 

Adds 

Multiplies 

Square 

Roots 

Adds 

Multiplies 

Square 

Roots 

LOS.l 

1126 

1351 

14 

724 

1176 

LOS.  2 

12R 

247 

10 

124 

176 

INERT.! 

4A 

28 

0 

732 

1199 

INERT. 2 

32 

18 

0 

134 

193 

Then  using 

Che 

following  express 

ion  to  get 

the  time 

required  per 

time  propagation  and  update  respectively: 


=  HA  CA  +  riM  Cm  +  ns  tg  (5-9a) 

=  "'a  tA  +  n'f;  tM  +  n's  tS  (5-9b) 


where 


n  =  number  oF  operations  in  the  time  propagation 
0"=  number  of  operation  in  the  update 

the  subscripts  a,  m,and  s  refer  to  the  groupings  of  adds, 
multiplies,  and  square  roots,  respectively 
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Reasonable  values  for  the  operation  times  for  some  smaller 
state-of-the-art  computers  are 

tg  -  2.1  u  sec 
tn  =  5.3  p  sec 
ts  “  60.0  VI  sec 

Summarizing  the  above  times  and  Table  5-3  will  yield 


TABLE  5-4 

FILTER  OPERATION  TIMES 


FILTER 

filte:^  operatiom  time  (sec)  per 

Time  Propagation 

Update 

LOS.l 

.0U0405 

.0082476 

LOS.  2 

.0022547 

.0013276 

INERT. 1 

.0002672 

.0087511 

INERT. 2 

.oooisia 

.0017447 

The  cases  run  in  this  study  were  wltli  a  time  propagations  rate  of 
50  Hertz  and  update  rate  of  10  Hertz.  However,  for  this  example  let  the 
update  rate  be  fixed  at  10  Hertz  and  determine  the  tnaxlTnum  time 
propagation  rate  as  an  Integer  multiple  of  the  update  rate. 

Synchronizing  the  update  with  time  propagations  will  simplify  the  timing 
and  sequencing  task  of  the  onboard  executive.  To  determine  this  upper 
limit,  first  multiply  the  time  per  update  by  the  update  rate  and 
subtract  from  one  second.  This  remaining  time  is  available  for 
propagating  the  filter  states  and  ts  then  divided  by  the  time  per 
propagation.  The  resulting  figure  can  then  be  rounded  down  to  the  next 
'iUtltlple  of  the  update  rate  giving  the  maximum 


time  propagation  rate.  This  computation  does  not  take  into  account  the 
time  required  by  the  processor  to  perform  other  tasks,  but  does  provide 
a  meaningful  measure  of  the  impact  of  the  filter  on  the  onboard 
processor  load  requirements. 

TABLE  5-5 

MAXIMUM  TIME  PROPAGATION  RATES 


FILTER 

Time  for  Ten 
Updates  (Sec) 

Time  for  Time 
Propagation  (Sec) 

Maximum  Time 
Propagation  Rate 

LOS.l 

.082476 

.917524 

83.1  or  80 

LOS.  2 

.013276 

.986724 

473.6  or  430 

INERT. 1 

.087511 

.912489 

3415.0  or  3410 

INERT.  2 

.017447 

.982443 

5404.6  or  5400 

There  are  two  principle  differences  between  the  LOS  filter  and  the 
inertial  filter  that  affect  the  run  times.  First  is  that  the  LOS 
filter  requires  an  Extended  Kalman  Filter  structure  for  both  time 
propagation  and  update.  The  Inertial  filter  is  linear  in  the  time 
propagation  and  uses  the  standard  Kalman  Filter  structure  there  and  the 
Extended  Kalman  Filter  structure  for  the  update.  The  second 
contributing  factor  is  that  the  LOS  filter  has  a  reference  coordinate 
frame  that  changes  its  orientation  with  time.  This  produces  an 
addition  computational  burden  by  requiring  the  uses  of  trigonometric 
functions  and  addition  square  root  operations. 

5.4  Guidance  Law 

The  proportional  navigation  guidance  law  performed  equally  well 
with  each  of  the  filters  used  in  this  study.  However,  the  guidance  law 
showed  signs  of  instability  as  the  missile  closed  in  on  the  target. 


The  cause  lies  in  using  the  mlssile-to-target  range  to  compute  the  rate 
of  change  of  the  misslle-to-target  llne-of-sight  angle.  Since  the 
Rm/T  term  Is  In  the  denominator  of  the  expression,  the  commanded 
acceleration  becomes  Increasingly  sensitive  as  the  range  gets  small. 

The  standard  deviation  of  the  range  error  Is  on  the  order  of  90  ft  in 
the  end  game.  This  could  cause  the  guidance  law  computation  to  produce 
very  large  numbers  since  the  range  estimate  could  In  fact  go  through 
zero.  The  two  potential  cures  for  this  are  to  use  a  time  varying  gain 
coefficient  or  to  limit  the  missile-to-target  range  In  the  filter  to  a 
predetermined  minimum.  In  this  simulation  this  range  was  limited  to  a 
minimum  of  100  ft. 

The  effect  of  varying  the  gain  in  the  guidance  law  in  illustrated 
In  Figures  F-61  through  F-66.  Another  figure  of  merit,  Eq,  relating 
to  the  control  energy  commanded  by 
tf 

Ec  '  /  AcmC  (5-10) 

The  acceleration  profile  was  not  noticeably  effected  by  changing  the 
filters  used  In  this  simulation.  The  following  table  presents  the 
effects  of  a  range  of  gains  in  the  guidance  law  to  control  energy  and 
miss  distance  for  the  LOS  filter. 


TABLE  5-6 

GUIDANCE  I.AW  PERFORMANCE 


CONTROL 

ENERGY 

MISS 

DISTANCE 

Pk 

Gain 

Mean 

Std.  Dev. 

Mean 

Std.  Dev. 

B 

1292.9 

112.9 

-.99 

6.97 

CO 

1117.5 

114.3 

.47 

2.92 

.86 

B 

1009.6 

121.0 

_ 

1.13 

1.86 

.90 
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The  control  energy  commanded  decreases  as  the  gain  Increases  but  also 
note  that  the  standard  deviation  increases,  caused  by  Increased 
sensitivity  to  perturbations  in  the  filter  states.  The  effect  of  the 
increasing  gain  also  has  a  marked  improvement  in  the  standard  deviation 
of  miss  distance.  However,  in  looking  at  Figures  F-64  through  F-66, 
there  is  an  Increase  in  the  Instability  in  the  end  game  as  mentioned 
above.  The  probability  of  kill  also  increases  with  the  gain.  However, 
the  improvement  in  resulting  from  the  gain  changing  from  4  to  5  is 
much  less  than  from  the  gain  changing  from  3  to  4.  With  the  tradeoffs 
Involved,  a  gain  of  4  would  give  the  better  improvement  in  Pr  with 
only  a  modest  degradation  from  the  end  game  instabilities.  The  optimum 
configuration  of  gain,  accepted  miss  distance  and  controls  in  the 
guidance  law  to  limit  the  instability  may  vary  as  a  function  of  launch 
scenario  and  warrants  further  study. 

5.5  Summary 


In  the  analysis  of  the  filter  developments,  the  method  of 
integration  proved  to  be  of  significant  importance  in  both  the 
stability  of  the  filter  covariance  and  the  accuracy  of  the  state 
estimates.  The  performance  of  the  filter  with  respect  to  probability  of 
kill  and  computer  loading  show  both  filters  studied  to  be  viable 
candidates  for  a  weapon  system  simulated  in  this  study.  From  this 
study,  the  use  of  a  Kalman  Filter  as  a  state  estimator  onboard  the  HVM 
is  a  very  feasible  and  viable  approach  to  the  guidance  realization. 
Accompanying  the  filter,  the  guidance  law  selected  becomes  a  recognized 
factor  in  the  final  performance  of  the  missile. 
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VI.  CONCLUSIONS  AND  RECOMMENDATIONS 


6.1  Conclusions 


A  single  mlssile-to-target  trajectory  was  used  in  this  study 
(Fig.  4.2).  The  scenario  Involves  a  stationary  target  and  a  constant- 
velocity  aircraft.  The  missile,  aircraft,  and  target  are  driven  by 
time-correlated  noise  at  the  acceleration  level. 

Given  these  conditions,  the  following  filter  design  analysis 
results  were  obtained: 

1)  The  LOS  filters  exhibited  a  probability  of  kill  on  the  order  of 
20  percent  higher  than  the  inertial  filters.  The  major 
contributing  factor  is  improved  observability  provided  by  the 
rotating  reference  frame  in  the  LOS  filter. 

2)  The  probability  of  kill  of  the  reduced  order  filters  was  within 
4  percent  of  their  full-order  counterparts. 

3)  The  six-state  Inertial  filter  required  additional  measurement 
information  to  meet  observability  criteria.  The  additional 
measurements  were  generated  as  pseudo-measurements  of  air-to- 
target  and  raissile-to-target  range,  expressed  in  terras  of 
filter  states  and  parameters-  The  pseudo-measurements  provided 
reduced  filter  covariance  in  the  aircraf t-to-target  states. 

4)  The  eight-state  LOS  filter  did  not  require  the  additional 
measurement  information.  However,  as  the  rate  of  change 

of  the  aircraf t-to-target  line-of-sight  approached  zero,  the 
filter  exhibited  reduced  observability. 


5)  The  Inercial  filter  required  significantly  fewer  computations 
per  time  propagation  (Ref.  Figure  5-5).  Since  both  filter  types 
used  the  same  update  method,  the  number  of  computations  per 
update  were  on  the  same  order. 

6)  The  use  of  Euler  integration  to  propagate  the  filter  states  at 
a  .02  second  step  time  proved  inadequate  because  of  the  large 
time-varying  accelerations  exhibited  by  the  missile.  A  higher 
order  Integration  scheme  (trapezoidal)  reduced  the  errors 
significantly. 

Proportional  navigation  was  the  guidance  law  implemented  for  each 
of  the  filters.  A  brief  analysis  of  this  guidance  law  for  the  LOS 
filter  and  a  single  scenario  (Figure  4-2)  revealed  the  following: 

1)  The  probability  of  kill  Improved  as  the  guidance  law  gain,  n, 
was  Increased. 

2)  The  total  control  energy  needed  by  the  guidance  law  decreased  as 
n  was  increased.  The  commanded  accelerations  were  higher 
during  thrust  while  the  kinetic  energy  is  lower  thus  reducing 
the  needed  course  corrections  later  in  flight. 

3)  The  commanded  accelerations  demonstrated  increased  instability 
toward  the  end-game  trajectory  as  n  increased. 

6.2  Recommendations 


Suggestions  for  further  study,  as  pertains  to  performance 
analysis,  are  the  following: 

1)  fianeuvers  should  be  induced  in  both  the  aircraft  and  the 
target,  and  the  robustness  of  the  filters  to  these  changes 
examined . 
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2)  The  INS  data  should  be  corrupted  to  Improve  modeling  of  the 
actual  system  that  would  be  implemented.  The  performance 
analysis  should  be  done  again  and  comparisons  made  with  the 
original  system. 

3)  The  recovery  from  initial  conditions  perturbations  should 

be  further  investigated.  A  precomputed  gain  extended  Kalman 
filter  should  be  investigated  if  additional  robustness  is 
required. 

4)  The  effects  of  varying  propagation  and  update  rates  should  be 
examined. 

5)  The  Inertial  filter  pseudo-measurements  of  range  should  be 
replaced  by  real  world  measurements.  The  effect  of  encoding 
there  true  measurements  onto  the  laser  signal  from  the  aircraft 
should  be  investigated  by  performance  analysis  and  appropriate 
comparisons.  This  should  also  be  done  with  the  LOS  filter  for 
comparison. 

The  reduced  order  models  used  in  this  study  are  representative  of 
many  possible  models.  Further  reduction  in  order  as  well  as  other 
combinations  of  filter  states  should  be  considered  to  obtain  an  optimum 
configuration.  In  conjunction  with  this,  the  white  noise  models  for 
acceleration  uncertainties  in  the  filters  should  be  replaced  by 
Gauss-Markov  models  and  the  corresponding  performance  analyzed. 

An  error  budget  analysis  is  necessary  to  identify  sources  that  can 
potentially  degrade  performance.  Once  these  are  determined,  methods 
are  used  to  reduce  their  effects.  In  order  to  accomplish  the  analysis 
it  is  necessary  to 

1)  Modify  the  truth  model  by  incorporating  more  exact  models  for 
the  individual  noise  sources. 


I 
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2)  With  an  appropriate  Kalman  Filter  in  the  system,  turn  off 

each  of  the  noises  one  at  the  time  and  obtain  a  comparison  of 
their  effects  on  miss  distance  statistics. 

Since  the  guidance  law  has  a  direct  bearing  on  the  performance  of 
navigation  system,  further  study  to  optimize  the  guidance  law  should 
i nclude ; 

1)  Other  guidance  law  formulations. 

2)  Algorithms  to  handle  potential  angle-of-incldence  difficulties. 

3)  Algorithms  to  avoid  potential  clobber  (flight  trajectory 
hitting  the  ground  before  intercepting  the  target) . 

The  simulation  developed  in  this  study  provides  a  tool  for  further 
analysis . 


*  » 
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APPENDIX  A 


COORDINATE  TRANSFORMATIONS 


A. I  Inertial  and  Missile  Frame  Transformations 

The  missile  body  frame  (n)  and  f.he  inertial  frame  (i)  are 
described  in  Chapter  II.  Based  upon  these  definitions,  the  ra  frame 
differs  from  the  I  frame  by  first  a  rotation,  S',  about  the  I3  axis  to 
form  an  intermediate  frame  h.  Figure  A-1  provides  a  top  view  of  this 
situation,  looking  do^n  onto  the  ij ,  13  plane.  Thus,  the  vector 
describing  the  rotation  of  the  f.  frame  with  respect  to  the  1  frame  is 

(ohl  =  V  %  =  S'  63  (A-1) 


Resolving  fi  into  f  components  results  in 

*  cos  S'  i^  +  sin  S'  i2  (A-2) 

h2  =  -sin  S'  li  +  cos  S'  I2  (A-3) 

A  A 

h3  -  13  (A-A) 

Therefore,  the  direction  cosine  matrix  which  transfonas  from  the  i 
frame  to  the  h  frame  is 


[Chi] 


cos  S' 
-sin  S' 
0 


sin  V  n 

cos  S'  0 

0  I 


(A-5) 


The  m  frame  next  differs  from  tlie  i  frame  by  a  rotation,  0,  about  the 
h  axis.  Figure  A-2  depicts  a  planar  side  view  of  the  h]^ ,  (13  plane. 


The’^vecCor  describing  the  rotation  of  the  m  frame  with  respect  to  the 
fi  frame  Is 

^mh  =  0  (12  =  G  m2  (A-6) 


Therefore,  the  rotation  of  the  m  frame  with  respect  to  the  1  frame  is 
ujmi  =  (otnh  +  (Jil  (A-7) 

Substituting  (A-1)  and  (A-6)  into  (A-7)  and  expressing  the  result  in 
the  missile  frame  coordinates  gives 


wmi  =  sin  0  m]  +  0  m2  +  cos  0  m3 
Expressing  m  in  terms  of  h  results  in 


(A-8) 


tni  = 

COS 

0  hi 

" 

sin 

0  h3 

(A-9) 

It 

A 

h2 

(A-10) 

m3  = 

sin 

0  hi 

Hh 

cos 

0  h3 

(A-11) 

Therefore, 

the 

direction 

cosine 

matrix  which  transform  the 

the  ra  frame  is 

cos 

0 

0 

-sin  0~] 

(A-12) 

[Crah]  = 

0 

1 

0 

sin 

0 

0 

cos  0  1 

Finally,  the  direction  cosine  matrix  which  transforms  the  i  frame  to 
the  ra  frame  is 


[Cmi]  =  [cn‘h][chi] 


(A-13) 


cos  0  cos  V 
-  sin  'V 
sin  0  cos  f 


cos  0  sin  f 
cos  'F 

sin  0  sin  "F 


-sin  0 
0 

cos  0 


For  the  two  dimensional  case  which  is  Implemented,  in  this  study 
Y  is  zero  and  [C"*!]  reduces  to  equation  (A-12). 
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A. 2  Inertial  and  ATLOS  Frame  Transformations 


The  ATLOS  frame  Is  also  described  in  Chapter  II.  Transformations 
between  the  inertial  and  the.  ATLOS  frame  are  needed  to  compute  true 
azimuth  and  elevation.  The  ATLOS-to-lnertlal  transformation  is 
Identical  in  form  to  the  mlsslle-to-lnertlal  transformation.  The  only 
difference  is  that  0  is  replaced  by  0£  and  f  is  replaced  by 
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Simulation  Implementation 


B.l  Missile  Attitude  Response  Model 


The  attitude  response  of  the  missile  to  commanded  acceleration  is 
modeled  as  a  second  order  lag  of  the  following  form: 


aOfDL  <% 

5^  +  2  ?(i)n  s  +  Ulfi^ 


aCMDN 

s2  +  2cu)ns  +  ii»n^ 


(B-1) 


(B-2) 


where  in  this  study 


*  guidance  law  commanded  lateral  acceleration 
CMDL  ' 

“  guidance  law  commanded  normal  acceleration 

CMDN 

?  *  damping  coefficient,  .707 

=  missile  natural  frequency,  44  radians  per  second 

The  values  for  damping  coefficient  and  missile  natural  frequency  were 
selected  as  being  representative  numbers  applicable  to  a  highly 
maneuverable  missile.  (Ref.  15) 

In  state  equation  form,  (B-1)  and  (3-2)  are  written  as 


x(t)  ••  A  x(t)  +  B  u(t) 


2^(t)  *_Hx(t)  +  ^^(t) 


(B-3) 


(B-4) 


where 


x(t)  =  vector  of  state  variables 
and  aw 

ii(t)  =  acMDL  fil'd  fiCMDN 

Since  this  function  will  be  called  frequently  and  parameters  will 
not  normally  be  change  after  initialization,  this  model  is  implemented 
as  a  difference  equation 

2i(ti+l)  =^(ti+i,  ti)  2c(ti)  +  2l  aCMD(tl)  (B-5) 

where 

ti)  =  [(S_I  -  ^)“1]  =  the  inverse  Laplace  transform 

of  the  inverse  of  the  matrix  (SI  - 

^(tl+1.  ti)  B(ti)  dt 

assuming  that  a^MD  is  constant  over  the  interval  from  ti  to  ti+i- 
Since  the  integration  step  size  is  fixed,  the  values  used  for  ♦  and 
Bj  are  computed  initially  and  remain  constant  during  each  computer  run. 
This  flexibility  in  the  input  parameters  permits  changing  (»)„  and  C 
should  the  simulation  later  warrant  such  a  change. 
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B«j'  Euler  Integration 

The  state  equations  that  are  Integrated  using  the  Euler  Integration 
technique  use  the  following  form 

x(ti)  =  x(ti-i)  +  x(ti-i)  At 
where 

“  value  of  state  at  sample  time  (tl-1) 
x(tj_l)  =  value  of  derivative  of  state  at  sample  time  (tl-1) 

The  Euler  integration  Is  used  where  the  time  constants  associated 
with  x(t£_^)  are  relatively  large  with  respect  to  the  .02  second 
integration  step  time  used. 

B.3  Trapezoidal  Integration 


In  the  case  of  propagating  the  filter  states,  Euler  integration 
did  not  provide  the  accuracy  needed.  The  Improved  integration  was 
implemented  as  a  trapezoidal  integration  as 

[x(ti)  -  x(ti_i)]  At 
x(ti)  =  x(ti-i)  + - ^ - 

where  the  parameters  are  as  defined  above. 
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APPENDIX  C 


FILTER  EQUATIONS 


C.I  Llne-of-Slght  Coordinate  Filter  Equations 

The  state  variables  are  referenced  to  the  aircvaf t-to-target  line-of 
sight.  See  Figure  3-1. 

The  filter  propagation  equations  are 


^(t)  u(ti),  til  +  G(ti)  w(ti)  (C-1) 

P(t^)  =  J(t)  P(t^)  +  P(t^)  F(t^)T  +  G(t^)  Q(t^)  GT(t^)  (C-2) 
The  update  equations  are 

K(ti)  -  P(tp  HT[t^.x(tpl 

li[C^,x(ep]  P(tp  HT[t^.x(tp  +  R(t^)]"^ 


x(tp  “  i(tp  +  K(t^)  C(t^)  -  h[x(tp,  t^] 

P(tp  -  P(tp  -  K(tp  H[t^,  x(tp]  P(tp 


State  Variables 


i(t) 


^M/T 

%/T 

01 

^A/T 

Ra/t 


“A 


missile  position  below  LOS 
missile  velocity  below  LOS 
missile  position  along  LOS 
missile  velocity  along  LOS 
Inclination  of  LOS 
aircraft  position  along  LOS 
aircraft  velocity  along  LOS 


(C-3) 


(C-4) 


(C-5) 


(C-6) 


rate  of  change  of  LOS,  if  used 
in  reduced  order  filters 


C-1 


Sta^e  Transition  Equations 


J(x(tj),  u(t),t] 


and  If  (til  is 
needed: 


-2  %/T  (til  +  ai  sin  Og  +  33  cos  Og 
~  ^‘M/T  “ji+  z  “I 

R.m/t 

2  2  a>,  +  R  w2  +  20). 
i  M/T  Z  Z 

+  a,  cos  a.  sin  0 

1  13  Z 

■(tig 

^A/T 

+2(ti  R  ,  0'  +  R  ,  (0)2  +  J)  0^) 

Z  A/T  A/T^  1  1 


2 

V’a/t  0' 


r2 

\/T 


(C-7) 


where  0"  >=  tan(0jj  -  0^^ 
Percubatlons  of  the  State  Equations 


F(t) 


'  0. 

1. 

0. 

0. 

0. 

0. 

0. 

Oa 

CM 

3 

0. 

■“1 

-2(tig 

F25 

0. 

0. 

F28 

0. 

0. 

0. 

1. 

0. 

0. 

0. 

0. 

“1 

2  (tig 

2 

UJ 

0. 

F45 

0. 

0. 

F48 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

-1 

0. 

0. 

0. 

0. 

0. 

0. 

1. 

0. 

0. 

0. 

0. 

0. 

F75 

F76 

F77 

F78 

0. 

0. 

.  0. 

0. 

^85 

F86 

F87 

0. 

where  x  Is  evaluated  at  H 


C-2 


and- 


F25  =  +ai  cos  0)1  -  33  sin  0)i 
F28  =•  -2  Rm/t  +  2  Rm/t 
F45  =  -ai  sin  Qi  -33  cos  Ojt 
F48  =  +22  +  2  Rm/t  <*i« 


F75  -  +(2  Vt  Vt  “«>  ■“'  -  V 


F76  =  U)2  +  u  ^an(0  J  ^ 

F77  =  +2a)ji  tan  (0ji  -  0a) 

^78  =  +2  Ra/T  tan  (0i  -  0a)  +  2  Ra/t 


-2  V2 
A/T 


F85 


r2 

A/T 


sec^  (0ji  -  0a) 


"i/T 


F86 


'a/t 


Va/t 

F87 - e' 


"a/i 


and  0'  defined  above  in  equation  (C-7) . 


Measurement  Model 


h(t)  =  sln~^ 


Ra/t  -  Rm/t 

Pertubatlons  of  the  Measurement  Model 


n(t) 


A 

-  0 


zA 


-zA 


B 


L. 


b2 


0 


b2 


(c- 


(C- 


C-3 


whare 


[-(- 


ty 


1/2 


Measurement  Covariance 


and  B  =  (Ra/T  “  Rm/t) 


E[v(ti)]  =  0 
E[v(ti)  vT(tj)] 


[  R6ij(t) 
0 


1 


1  =  j 
i  *  i 


Noise 


(C-11) 


0. 

0. 

0. 

1. 

0. 

-sin 

cos  04 

sin  04 

0. 

0. 

1 

0. 

0. 

0. 

0. 

0. 

G(t)  = 

-cos  9jj 

-sin  04 

cos  04 

0. 

0. 

0. 

0. 

0. 

0. 

0. 

(C-12) 

0. 

0. 

0. 

0. 

0. 

1 

0. 

0. 

0. 

0, 

1. 

Strength  of 

driving  i 

noise  (Ref. 

Section 

2.6  for 

Development 

of  Values) 

"qi 

0. 

0. 

0. 

0. 

0. 

Q2 

0. 

0. 

0. 

Q(t)  - 

0. 

0. 

Q3 

0. 

0. 

(C-13) 

0. 

0. 

0. 

Q4 

0. 

0. 

0. 

0. 

0. 

Qs 

C-4 


The  previous  noise  terms  are  associated  with  the  following  parameters 

=  horizontal  target  velocity 
Q2  “  vertical  missile  velocity 
Q3  =  horizontal  missile  velocity 
Q4  =  change  In  o)  due  to  A/C  motion 
Q5  “  due  to  A/C  motion 

For  this  filter  the  noise  is  Implemented  sucli  that 

Qd  =  G(t)  (2(t)  GT(t)  (C-14) 

and 

Gd(t)  =  I 

Then  Qd  can  be  expressed  as 

Qdd.l)  “  1- 

Qd(2,2)  =  Qi  sln2  +  Q2  cos^  0^  -1-  Q3  sin^  0jj 
Qd(2,4)  =  (Qi  -  Q2  +  Q3)  slf  ©4 

Qd(^.2)  =  qd(2,A) 

QdC^.*^)  =  Ql  cos^  0|^  +  02  sln2  +  Q3  cos^ 

Qd(7,7)  -  1. 

all  other  components  are  zero 

These  values  serve  as  initial  values  for  P  the  filter  testing, 
z  =  (0  ft) 2  perfect  knowledge  of  z  at  launch 
z  =  (2  ft/ sec) 2  same  as  A/C 
%i/T  “  (150  ft)2  from  the  tracker 
^H/T  ’  (2  ft/sec)2  sane  as  A/C 


C-5 


The  measurements  available  to  this  filter  are 


EL  - 

Rm/t  • 

%/T  ' 

The  H-ma 

H(l,2)  = 

H(l,l)  = 

11(1,3)  = 

K(l,5)  = 

H(2,2)  = 

H(2.1)  = 


tan“^ 


tan~l 


X3  -  x7 
XI  -  x5 


(x2  +  x2)l/2 


+  X 


2 

A/T 


)l/2 


rlx  partial  derivatives  are 

H(l,4)  =  11(1,6)  =  0 

XT  -  X7 

(xi  -  x5)2  +  (x3  -  x7)2 
X5  -  XI 

(xi  -  x5)2  +  (X3  -  x7)2 


^7  -  X3 


(xi  -  x5)2  +  (x3  -  x7)2 


(C-26) 

(C-27) 

(C-28) 

(C-29) 

(C-30) 

(C-31) 

(C-32) 


H(2,4)  =  H(2,5)  =  a(2,6)  =  0 


(C-33) 


’'I 

-  (C-34) 

(x^  +  x2)l/2 


C-8 


*3 


(C-35) 


H(2.3)  - - 

(x2  +  x^)l/2 


H(3,l)  =  H(3,2)  =  H(3.3)  =  H93,4)  =  11(3,6)  -  0 


(C-36) 


H(3.5) 


(C-37) 


The  measurement  noise  strength  Is  represented  by 


Rl  0  0 

0  R2  0 

0  0  R3 


(C-38) 


The  magnitudes  of  the  noises  are  discussed  In  Chapter  III. 


Fourth  Order  Model.  The  filter  equations  are  described  in  (C-15) 
through  (C-19).  The  corresponding  matrices  are 


0 

1 

0 

n 

0 

0 

0 

d 

0 

0 

0 

0 

(C-39) 

G  = 

1 

0 

1 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

1 

(C-40) 


C-9 


(C-44) 


4  » 


C-10 


EL  •>  tan”^ 


■*A/f 

JXA/T 


*3  -  ZA/t 
XI  “  XA/T 


Rm/T  =  (xf  + 


The  H-matrlx  partial  derivatives  are 


H(l,2)  =  H(l,4)  -  0 


H(l.l) 


H(l,3) 


_ ^3  -  ZA/T 

(xi  -  xa/t)2  +  (X3  -  2a/t)^ 


_ XA/T  -  XI 

<xi  -  xa/t)2  +  (X3  -  za/t)2 


H(2,2)  =  H(2,A)  =  0 


H(2.l) 


H(2,3) 


(x2  +  x^)l/2 


(x^  +  x2)l/2 


The  measurement  noise  strength  Is  represented  by 


Rl  0 


0  R2 


(C-46) 


(C-47) 


(C-48) 


(C-49) 


(C-50) 


(C-51) 


(C-52) 


(C-53) 


(C-54) 
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C-11 
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APPENDIX  D 

SIMULATION  PARAMETERS  AND  FLIGHT  PROFILES 


This  appendix  Is  a  brief  summary  of  the  parameters,  assumptions 
and  flight  profiles  used  in  developing  and  running  the  simulation.  The 
truth  model  developed  in  Chapter  II  has  a  three-dimensional  capability 
while  the  filters  developed  in  Chapter  III  are  restricted  to  only  two 
dimensions.  The  parameters  listed  below  include  Information  about  all 
three  dimensions  but  in  the  final  implementation  all  parameters 
Involving  lateral  motion  were  set  to  zero.  (Ref.  11) 


TABLE  D-1 

Aircraft  Parameters  Used 


High  dynamics  air  superiority 

fighter  of  the  F15  class 

Natural  frequency 

3  rad/sec 

Correlation  time  constant 

2  sec 

Constant  velocity 

500  ft/sec 

Wind  buffeting  effects 

3  ft/sec/sec 

Maximum  axial  acceleration 

6A  ft/sec/sec 

Maximum  vertical  acceleration 

290  ft/sec/sec 

Maximum  lateral  acceleration 

290  ft/sec/sec 

Onboard  IMS  accuracy 

4  f t/sec 

IR  tracker  accuracy 

3  milli-rad  angular  resolution 
and  150  ft  range  resolution 

Only  time  correlated  white  Gaussian  noise  is  added  to  the 
vertical  and  axial  acceleration. 

TABLE  U-2 

Missile 

Parameters  Used: 

Hyper-velocity  missile 

Natural  frequency 

44.0  rad/sec  during  thrust 

44.0  rad/sec  after  burnout 

Correlation  time  constant 

0.14  sec  during  thrust 

0.14  sec  after  burnout 

Damping  coefficient 

.707 

Wind  buffeting  effects 

3  ft/sec/sec 

Maximum  lift 

3200  ft/sec/sec 

Propulsion 

solid  propellant 
boost-coast  profile 

Thrust 

5000  lbs 

Thrust  duration 

1.0  sec 

Flight  duration 

1.0  -  3.0  sec 

Body  size 

3.5  Inches  diameter 

72  Inches  In  length 

Body  weight 

26.7  lbs 

Fuel  weight 

25.9  lbs 

Drag  coefficient 

.35  during  thrust 
.45  during  coast 

Air  density 

.0023  slu8s/ft3 

Guidance  law 

proportional  navigation  (Ref.  2.5) 

TABLE  D."} 


Target  Parameters  Used: 


Highly  maneuverable  tank  of  the  Ml  class 

Natural  frequency 

31  rad/sec 

Correlation  time  constant 

.2  sec 

Constant  velocity 

0  ft/sec 

Maximum  axial  acceleration 

29  ft/sec/sec 

Maximum  lateral  acceleration 

16  ft/sec/sec 

Only  time  correlated  noise  is 
axial  acceleration. 

added  to  the 

The  following  three  flight  profiles  were  used  during  the  initial 
validation  of  the  truth  model  to  exercise  the  dynamics  equations.  The 
last  of  the  three  was  used  during  the  filter  analysis  as  a  typical 
mission  profile  with  a  down  range  distance  of  10,000  ft  and  altitude 
of  2000  ft.  Other  variations  of  this  last  profile  would  include 
shortening  the  slant  range  and  varying  the  angle  between  the  aircraft 
velocity  and  target  position. 


APPENDIX  E 


FILTER  ANALYSIS  PROOFS 

H-1  FORMULATION  OF  THE  SIMILARITY  TRANSFOPJ^ 

In  this  case  for  tfie  general  equations 

X  =  F  X  +  B  U  (E-1) 

£=£P  +  PFT+GjQ^T  (E-2) 

Let  a  transformation  vector  T  be  defined  such  that 

X  =  T  X*  (E-3) 

and  X  “ 

substituting  E-3  and  E-4  Into  E-1  and  E-2  produces 

1  k*  “11  !*■*■  1 1  (E-5) 

premultiplying  by  yields 

X  =  T-1  £  T  X*  +  T-1  B  U  (E-6) 

and  2*  “  1*1*  1*1^*  +  G*£*£T*  (S-7) 

where  F*  =  J"!  £  T  (E-8) 

£*  =  T-1  £  (E-9) 

£*  =•  T-1  G  (E-10) 

-t 

P*  m  'f-l  p  p 


4 


E-1 


(E-11) 


These  relationships  are  good  only  for  constant  T.  Also  note  that  the 
similarity  transform  on  the  ^matrix  will  preserve  it's  eigenvalues  in 
a  time  response  sense.  For  this  problem,  the  scaling  matrix  T  was 
chosen  such  that 

I  Ij  *  / 

This  would  let  (to)  be  an  identity  matrix.  Since  P(l,l)  at  t=0  was 
zero,  T(l)  was  set  to  1  and  later  to  that  of  P(3,3)  at  t=0,  which  is  a 
parameter  of  like  dimensions.  This  scaling  was  done  on  the  time 
propagations  while  the  updates  were  turned  off.  The  final  result  was 
that  the  scaled  covariance  matrix  had  the  same  problems  with  negative 
eigen-values  than  the  original  matrix. 

E-2  FORMULATION  OF  ROOTS  OF  THE  INTEGRATED  COVARIANCE  MATRIX 


for  i  =  j 


Plj  (to) 

0  for  i  j 


(E-12) 


The  Euler  integration  used  on  the  covariance  matrix  can  produce 
negative  eigenvalues.  This  principle  can  be  illustrated  as  follows. 
The  matrix  in  this  example,  as  In  the  filter,  has  no  real  eigen¬ 
values.  Now  consider  a  second  order  system  such  that 


and 


0 

a 

L  “ 

0 

0 

Pll 

Pl2  j 

P(to)  = 

Pl2 

P22J 

P  =  F  P  + 

^  ft  + 

in  this  case  G  Q 

CT 

=  0 

(E-13) 

(E-U) 

(E-15) 


First  solve  for  P  in  general  form 


0 

ab 


ab 

0 


(E-16) 


E-2 


Integrating  ^  using  Euler  Integration, 


as  In  the  simulation  will  yield 


P 


I’ll  Pl2  +  abSt 

Pl2  +  ab6t  P22 


(E-17) 


Obtaining  the  characteristic  equation  from  the  form  (XI  -  P)  and 
equation  E-17  will  yield 


X2  -  X  +  p^^  -  (P^^  +  ab6t)2)  X°  (E-18) 

note  that  the  X*’  terra  can  become  negative  If  (P12  +  abfit)^  >  Pn 
P12  and  will  then  produce  a  negative  root.  This  Is  what  was 
experienced  in  the  simulation  since  P^l  is  small  and  is  not  driven  by 

Q- 


Note  however  that  this  Is  using  Euler  integration  and  is  only  an 
approximation  to  the  true  solution  In  closed  form.  If  you  continue  the 
above  example  and  let  P^  »  0,  then  equation  E-16  can  be  expressed 
as 


Pll 

Pl2 

2aPi2 

aP22 

P12 

P22 

aP22 

0 

(E-19) 


breaking  up  the  components  of  the  matrix  and  expressing  them  as  vectors 
will  yield 


Pll 

0  2a  0  ‘ 

Pll' 

P12 

0  0a 

Pl2 

P22 

0  0  0 

P22 

(E-20) 


notice 


that  P72 


0  and  let  P22 


b,  a  constant  in  time.  Then 


Pll 

S 

0 

2a 

Pll 

+ 

0 

P12 

0 

0 

P12 

ab 

(E-21) 


E-3 


if  ^12  “  abj  Is  a  constant,  It  follows  that 


Pl2  abt 

Since  P]^2  is  a  growing  function  of  time  and  If  Pn 
It  follows  that 

Pll  -  2a2  bt2 

where 

a2  >  0 
t2  >  0 
b  >  0 

then  we  can  conclude  that  P^^  >  0  also  as  was  P22‘ 

The  off  diagonal  terms  may  or  may  not  be  negative,  but  the 
diagonal  terras  will  not  become  negative  If  P  (t)  Is  solved  in  closed 
form.  The  homogeneous  portion  of  the  solution  to  equation  E-20  has  the 
form 

At 

P(t)  =  e-  P(to)  (E-24) 

where 

0  2a  0 

A  =  0  0  a  (E-25) 

0  0  0 

Since  ^  is  a  matrix,  equation  E-24  can  be  solved  by  taking  the  Inverse 
Laplace  transform  of  (S  _I  ~  _A) .  This  yields 

Pll  (t)!  fl  2at  2a2t2  (t^)  ' 

Pl2  (t)  *■  0  1  at  Pl2  (to)  (E-26) 

P22  (t)  0  0  1  P22  (to) 


(E-22) 

=  2abPii  =•  2a2t 
(F-23) 


As  above,  P22  (t)  is  constant  with  time  and  P^]^  (t)  and  P12  (t) 
will  increase  positive  with  time. 


State  With  Euler  Integration  and  No  Truth  Model  Noise 


State  With  Trapezoidal  Integration  and  No  Truth  Model  Noise 


Statu  With  Trapezoidal  Integration  and  No  Truth  Model  Noise 


State  With  Computed  ^  ^  and  Dynam 
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Fig  F-9.  z  State  With  Tuned  Filter  Q  and  Perturbed  Initial  Conditions 


as  a  Computed  Parameter 


t»f«'nsn  0!S5Pi.<l  »tJ(  7.3 


-17.  R»/t  State  Profile  With  Acquisition  and  Dynamic  Driving  Noise 


Profile  With  Acquisition  and  Dynamic  Driving  Noise 


-19.  z  State  Errors,  Standard  Deviation,  and  Filter  Covariance 


State  Errors,  Standard  Deviation,  and  Filter  Covariance 


Fig  F-24.  cjj  Errors  and  Standard  Deviation 


-29.  Reduced  Order  Filter,  z  State  Errors 


‘•fwzvea  . 


Reduced  Order  Filter,  State  Errors 


fLOT  *^3  ncs  ;■*  fCi. 


Fig  F-33.  X  ,  Covariance  With  One  Measurement  and  No  System  Noise 


Fig  F-34.  X, /T  Covariance  With  Three  Measurements  and  No  System  Noise 


g  F-35.  K.irr,  State  With  Euler  Integration  and  No  Truth  Model  Noise 


Fig  F-37.  State  With  Decreased  Integration  Step  Size  and  No  Truth  Model  Noise 
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F-38 


State  With  Decreased  Integration  Step  Size  and  No  Truth  Model  Noise 


With  Computed  _P  ,  ^  and  Dynamic  Driving  Noise 


Fig  F-A2.  X  State  With  Tuned  Filter  ^  and  Dynamic  Driving  Noise 


Fig  F-44.  x^,„  State  With  Tuned  Filter  ^  and  Perturbed  Initial  Conditions 


Fig  F-45.  State  Profile  With  Acquisition  and  Dynamic  Driving  Noise 


State  Profile  With  Acquisition  and  Dynamic  Driving  Noise 


Fig  F-50.  ^a/'t  State  Profile  With  Acquisition  and  Dynamic  Driving  Noise 


54.  Errors,  St£indar<J  D<?viation  fliid  Filter  Covariance 


State  Errors,  Standard  Deviation  and  Filter  Covariance 


’-56.  X  .  State  Errors,  Standard  Deviation  and  Filter  Covariance 
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F-57 


Fig  F-57.  Elevation  Measurement  Residual  With  No  System  Noise 


Lg  F-58.  Elevation  Measurement  Residual  With  System  Noise 


Reduced  Order  Filter,  x., State  Errors 


Fig  F-61.  Reduced  Order  Filter,  z  .  State  Errors 


F-60 


Fig  F-60.  Reduced  Order  Filter,  State  Errors 
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F-62 


Reduced  Order  Filter,  State  Errors 


PROF 


F-63 


Fig  F-63.  Acceleration  Profile  With  a  Guidance  Law  Gain  of 


SSILE 


Fig  F-64.  Acceleration  Profile  With 


-65.  Acceleration  Profile  With  a  Guidance  Law  Gain  of  5 


Acceleration  Error  With  a  Guidance 


Lg  F-68.  Acceleration  Error  With  a  Guidance  Law  Gain  of 
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